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ABSTRACT 


A  computer  software  programming  technique  was 
developed  to  compensate  a  highly  oscillatory  robot 
system  controlled  by  a  bang-bang  input.  The  assump¬ 
tions  that  the  system  was  linear  and  had  lumped 
parameter  characteristics  allowed  a  fifth  order, 
simplified  dynamic  model  to  be  derived.  Analysis 
using  frequency  response  methods  led  to  further 
simplification  of  the  model  to  a  third  order  system. 
Based  on  the  third  order  model,  a  technique  was 
developed  which  would  compensate  the  system  with  a 
form  of  deadbeat  control.  Simulation  of  the  model 
driven  by  the  compensated  bang -bang  input  verified 
the  deadbeat  response.  The  technique  was  implemented 
on  an  8080-based  microcomputer  system  which  controlled 
the  input.  Actual  system  response  to  the  compensated 
input  was  observed  to  be  essentially  free  of  the 
undesirable  oscillatory  motions,  thus  yielding  an 
apparently  rigid  system. 
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PREFACE 


This  investigation  was  sponsored  by  the  Trident  Research 
Committee,  Naval  Academy  Research  Council,  and  conducted  at 
the  United  States  Naval  Academy,  Annapolis,  Maryland. 

Computer  simulation  was  conducted  using  the  Naval  Academy 
Time  Sharing  system,  while  the  remainder  of  the  work  was 
carried  out  in  the  Fluid  Control  and  Robotics  Laboratory  of 
the  Weapons  and  Systems  Engineering  Department.  The 
Technical  Support  Department  of  the  Naval  Academy  was  used 
extensively  throughout  the  course  of  research  for  hardware 
assistance  and-shop  facilities. 

I  would  like  to  thank  Associate  Professor  K.  A.  Knowles, 
my  faculty  advisor,  for  the  guidance  and  wisdom  which  he 
has  imparted  throughout  the  year.  Larry  Heisig,  John  Hill, 
and  Carvel  Holton,  and  others  of  the  Technical  Support 
Department  were  invaluable  in  helping  me  solve  some  of  my 
hardware  difficulties.  Bill  Lowe,  Rick  Boyer,  and  Clyde 
Atwell  were  instrumental  in  helping  me  get  this  project  on 
its  feet  and  keeping  it  there.  I  would  finally  like  to  thank 
Eric  Dyson  for  his  drawing  assistance  and  the  use  of  his 
equipment . 

This  report  uses  many  common  control  theory  methods, 
terms,  and  symbols.  It  is  assumed  that  the  reader  is  familiar 
with  the  basic  language  of  control  systems. 
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CHAPTER  ONE 
INTRODUCTION 

"So  far  the  predictions  about  what  robots  will 
do  in  the  home,  in  the  factory,  and  in  space, 
cannot  be  contradicted,  although  assessment  as 
to  how  soon  they  will  be  able  to  do  this  has  been 
consistently  over-optimistic.  Whatever  the  length 
of  time  required  for  these  predictions  to  come 
true  it's  already  obvious  that  man  has  little  to 
fear  from  robots,  but  that  he  could  well  fear 
a  future  without  them"  [l] 

"Robot"  has  become  a  household  term.  The  Random 
House  Dictionary  (Revised  Edition,  1975)  defines  a  robot  as 
"a  machine  which  resembles  a  man  and  does  mechanically  routine 
tasks  on  command."  The  general  public  recalls  visions  of 
R2-D2  and  C3P0,  as  shown  in  Figure  1.1,  or  the  unnamed 
robot  from  "Lost  in  Space,"  when  confronted  with  this 
subject.  Seldom  does  anyone  picture  a  robot  like  that  shown 
in  Figure  1.2. 

For  the  purposes  of  this  paper,  it  is  important 
to  define  what  a  robot  is  and  what  it  is  not.  A  robot  is  a 
computer  controlled,  reprogrammable,  mechanical  device  which 
can  perform  multiple  manipulative  tasks  without  external 
guidance.  An  automated  machine  tool  is  not  a  robot  because, 
even  though  it  may  be  computer  controlled,  it  can  only  perform 
the  single  task  for  which  it  was  designed.  There  are  mechan¬ 
ical  manipulators  which  can  perform  multiple  tasks,  but 
require  a  human  in  the  control  loop.  These  systems  are 
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known  as  teleoperators.  A  robot  differs  from  a  teleoperator 
in  that  it  must  be  able  to  perform  its  tasks  independent  of 
all  human  control. 

Robots  are  suited  to  perform  many  tasks.  They  are 
currently  used  in  industry  to  perform  jobs  ranging  from 
stacking  heavy  boxes  in  warehouses  to  assembling  watches. 

In  the  home,  robots  could  be  used  for  every  kind  of  house¬ 
hold  chore,  from  ironing  to  vacuuming  the  rug. 

This  project  was  concerned  with  the  type  of  robot 
commonly  found  in  industry.  The  logic  capabilities  of  a 
modern  computer  combined  with  the  manipulative  skills  of 
a  mechanical  arm,  make  robots  appealing  as  industrial 
workhorses.  As  technology  has  advanced,  so  have  the  tasks 
which  have  been  assigned  to  robots.  Designers  have  become 
increasingly  aware  of  the  need  to  build  robots  which  have 
very  precise  movements  and  are  very  accurate.  Only  these 
robots  can  perform  the  assembly  procedures  which  are  going  to 
be  routine  tasks  of  the  future. 

At  present,  designers  tend  to  rely  on  a  single  strategy 
to  achieve  accuracy:  design  the  robot  to  be  as  mechanically 
rigid  as  possible.  This  approach  accomplishes  the  desired 
goal,  but  at  the  expense  of  increased  weight,  increased  size, 
increased  cost,  enormous  power  requirements,  and  decreased 
adaptability  of  tasking.  In  the  future,  design  specifica¬ 
tions  will  demand  that  these  costs  be  decreased.  To  accom¬ 
plish  this,  the  designer  will  have  to  develop  a  robot  system 
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which  does  not  have  parasitic  (excessive)  mass  and  power 
requirements.  In  giving  up  the  excess  mass,  however,  the 
designer  will  be  losing  some  of  the  mechanical  rigidity 
which  was  required  to  make  the  robot  precise. 

To  meet  the  reduced  power  consumption  design 
specifications,  robots  of  the  future  will  possess  a  greater 
degree  of  mechanical  flexibility.  Flexibility,  as  it  will 
be  used  in  this  discussion,  is  the  tendency  of  a  system  to 
show  imprecise  motions  due  to  the  elastic  deformation  of 
its  components.  A  very  flexible  system  is  usually  greatly 
underdamped  and  thus  displays  highly  oscillatory  motion. 

If  a  designer  is  not  restricted  by  excessive  rigidity 
requirements,  he  can  more  easily  develop  a  light,  small, 
inexpensive  robot  system  which  will  be  power  efficient. 

The  task  of  the  robot  designer  of  the  future  will  be  to 
develop  a  robot  system  with  all  of  the  properties  discussed 
above,  but  which  appears  rigid  in  its  motion  in  order  to 
achieve  the  desired  degree  of  positional  accuracy. 

The  goal  of  the  research  outlined  herein  was  to  take 
an  existing  robot  manipulator  which  was  very  flexible  in 
one  axis  of  motion  and  enhance  its  performance  by  making  this 
motion  appear  to  be  more  rigid.  This  was  accomplished  by 
developing  a  computer  compensation  program  which  modified 
the  robot  control  signals  in  such  a  manner  as  to  permit  rapid 
manipulator  motions,  but  without  the  usual,  undesirable 
mechanical  oscillations. 
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CHAPTER  TWO 
THE  DINO  SYSTEM 

The  subject  of  the  research  was  a  robot  manipulator, 
shown  in  Figure  1.2.  It  is  located  in  the  Weapons  and 
Systems  Engineering  Department  of  the  United  States  Naval 
Academy,  in  the  Fluid  Control  and  Robotics  Laboratory  of  the 
Weapons  and  Systems  Engineering  Department,  and  it  has  been 
nicknamed  "DINO,"  short  for  "dinosaur,"  which  it  resembles. 

A  discussion  of  the  hardware  of  the  system  is  very 
important  to  understand  some  of  the  limitations  of  the 
investigation.  The  robot  manipulator  system  shown  in  Figure 
1.2  has  a  well  defined  range  of  motion,  limited  by  the  scope 
of  the  pistons  which  control  motion.  The  system  has  four 
degrees  of  freedom.  In  other  words,  the  end  effector  (hand) 
may  be  moved  anywhere  within  its  three  dimensional  range  of 
motion,  and  then  oriented  3long  one  axis. 

The  DINO  system  was  a  flexible  robot  system,  but  only 
one  degree  of  freedom  was  greatly  affected  by  this  flexi¬ 
bility.  The  axis  of  this  predominant  flexibility  was  the 
vertical,  or  z-axis.  In  other  words,  motion  in  the  horizon¬ 
tal  plane,  centered  on  the  vertical  hinges,  showed  the 
characteristic  underdamped  qualities  of  a  very  flexible 
system.  It  was  this  motion,  ana  only  this  motion,  which 
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the  investigator  tried  to  compensate.  There  was  no  great 
need  to  compensate  the  other  axes,  as  they  already 
appeared  to  be  fairly  rigid. 

The  mechanical  components  of  the  system  included 
the  following: 

an  aluminum  frame 

aluminum  I  -beam  forearm  and  upper  arm 
solenoid  control  valves 
hydraulic  pistons 
a  five  horsepower  hydraulic  pump 

specially  designed  precision  hinges  for  shoulder  and 
elbow  joints 

household  hinges  for  the  horizontal  axis  and  wrist  joint 

5 OK  potentiometers  for  measuring  steady  state  position 

an  end  effector  (hand)  designed  by  Associate  Professor 
K.  A.  Knowles 

a  Schaevitz  (1-G)  Accelerometer  for  measuring  instantaneous 
acceleration 

Solenoid  actuators  were  utilized  because  they  are 
relatively  inexpensive,  very  reliable,  and  tolerant  of 
fluid  contamination.  They  were  also  the  most  restrictive 
elements  of  the  system,  because  they  were  bang-bang  devices. 
Bang-bang  means  that  they  could  only  produce  three  outputs: 
a  fixed  flow  rate  to  the  pistons  in  one  direction,  zero  flow 
to  the  pistons,  and  a  fixed  flow  rate  to  the  pistons  in  the 
opposite  direction.  Such  inputs  are  normally  referred  to  as 
being  positive  steps,  zero,  and  negative  steps,  respectively. 
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The  usual  control  compensation  techniques  did  not  apply 
to  this  system  because  there  was  no  means  for  the  magnitude 
of  the  input  to  be  altered.  An  input  could  only  be  altered 
by  controlling  its  on  and  off  times,  not  its  magnitude. 

The  actuators  were  controlled  by  an  electrical  signal 
coming  from  a  microcomputer .  The  computer  hardware  included 
an  8080-Based  microcomputer  with  twin  floppy  disk  drives. 

The  software  language  used  was  Compiled  Microsoft  BASIC 
operating  under  the  CP/M  Operating  System.  A  high  level 
language  was  chosen  to  facilitate  program  writing  and 
implementation.  Compiled  microsoft  BASIC  is  almost  as  fast 
as  Microsoft  FORTRAN,  and  it  provided  adequate  control  of 
the  system. 
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CHAPTER  THREE 

SYSTEM  IDENTIFICATION  AND  MODELING 

The  purpose  of  this  chapter  is  to  outline  the 
procedure  used  to  create  a  model  of  the  flexible  robot 
manipulator  system  to  be  compensated.  A  model  is  an 
approximate  mathematical  description  of  a  physical  system. 

If  an  engineer  wishes  to  compensate  a  system  using  analytical 
methods,  he  must  first  create  an  appropriate  mathematical 
model  of  the  system  which  will  allow  him  to  do  this. 

The  procedure  outlined  in  this  chapter  for  finding  a 
model  to  describe  the  system  to  be  compensated  is  not 
unique  to  this  project.  There  are  fundamental  mathematical 
and  experimental  tools  which  are  available  and  were  used  to 
obtain  the  mathematical  description  of  the  system.  In  some 
ways,  this  system  is  similar  to  most  mechanical  systems, 
allowing  for  some  general  analytical  tools  to  be  of  assistance 
in  identifying  system  characteristics.  In  other  ways,  the 
peculiarities  of  the  system  and  the  goals  of  the  project 
called  for  unique  analyses  and  assumptions. 

3 . 1  The  Basis  for  the  Model 

A  knowledge  of  the  physical  laws  which  govern  this  system 
was  the  basis  for  constructing  the  model.  In  every  case,  a 
model  is  a  simplification  of  the  actual  system.  Therefore, 
it  is  the  task  of  the  engineer  to  decide  which  simplifying 
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assumptions  he  wishes  to  apply  to  his  model.  It  should  be 
mentioned  that  all  of  the  simplifying  assumptions  were  chosen 
to  facilitate  the  analysis  of  the  compensation  technique  as 
well  as  to  accurately  describe  the  system.  There  is  an  in¬ 
herent  trade-off  between  these  two  factors.  To  develop  a 
simple  and  realistic  compensation  technique,  it  is  desirable 
to  have  a  simple  model  of  the  physical  system.  It  is  like¬ 
wise  desirable  for  the  model  to  accurately  describe  the  system, 
but  as  a  model  more  closely  resembles  the  actual  system,  it 
necessarily  becomes  more  complicated. 

The  first  assumption  made  was  that  the  system  was 
deterministic.-  This  meant  that  the  system  output  (r^jponse) 
was  solely  a  function  of  the  system  input  (excitation)  and 
the  s>stem  parameters.  In  other  words,  the  system  was  not 
random. 

For  the  purposes  of  the  model,  it  was  assumed  that  the 
parameters  of  the  system  were  fixed  and  constant.  This 
assumption  was  chosen  because  of  the  difficulty  of  measuring 
most  of  the  system  parameters  and  the  impossibility  of  control¬ 
ling  them  with  the  computer. 

One  of  the  most  important  assumptions  was  that  the 
system  was  linear.  This  meant  that  the  system  obeyed  the 
laws  of  superposition. 

m 

These  laws  are  as  follows: 

1)  Multiplying  the  inputs  by  any  constant  must 
multiply  the  output  by  the  same  constant. 


where  f (x)  =  y  and  a  =  constant 

2)  The  response  to  several  inputs  applied 

simultaneously  must  be  the  sum  of  the  individual 
responses  to  each  input  applied  separately, 
f  (x  +  u)  =  y  +  z 
where  f(x)  =  y 

and  f  (u)  =  z 

It  was  difficult  to  test  the  conditions  of  superposition 
to  determine  the  validity  of  the  assumption  of  linearity, 
because  of  the  nature  of  the  input.  The  input  was  limited 
to  a  positive  step  input,  u,  a  negative  step  input,  -u,  and 
a  zero  step  input,  0.  The  first  condition  could  only  be 
tested  as  follows:  f (u)  =  -f(-u)  where  a  =  -1.  Any  other 
test  for  the  first  condition  would  be  trivial.  The  second 
condition  could  not  be  tested  at  all,  because  only  one  input 
could  be  fed  into  the  system  at  a  time.  The  second  condition 
calls  for  two  inputs,  which  is  impossible  for  this  system. 

The  final  assumption  was  that  the  manipulator  could  be 
described  by  a  lumped  parameter  system.  Therefore,  the 
system  could  be  modeled  with  a  finite  number  of  state 
variables.  ^  This  assumption  greatly  facilitated  the 
mathematical  manipulation  of  the  dynamics  of  the  system. 

The  model  was  thus  governed  by  the  assumptions  which  were 
deemed  important  by  the  investigator.  It  was  then  the 
investigator's  task  to  determine  the  transfer  function 


15 


characteristics  of  the  system  based  on  these  assumptions. 

3 . 2  Methods  of  Determining  a  Transfer  Function 

There  are  three  general  methods  by  which  the  characteristic 
parameters  of  physical  systems  may  be  determined: 

(1)  System  analysis  leads  to  a  transfer  function  in 
terms  of  system  parameters  which  are  evaluated  by  experimental 
tests.  In  the  analysis  of  a  translational  hydraulic  pilot 
valve  and  power  piston,  for  example,  the  behavior  of  the 
various  components  is  described  by  a  set  of  equations  based 

on  physical  laws.  On  the  basis  of  the  probable  excitation 
and  load,  suit-able  linearizing  assumptions  are  made.  The 
transfer  function  is  then  derived  from  these  linear  equations. 
Finally,  the  parameters  (the  oil  compressibility,  the  flow/ 
displacement  ratio  of  the  pilot  valve,  the  load  mass,  spring 
constant,  damping,  etc.)  are  evaluated  either  experimentally 
or  theoretically. 

(2)  The  sinusoidal  characteristics  of  the  system  are 
determined.  With  the  components  excited  by  a  variable - 
frequency  sine-wave  generator,  the  input  and  output  amplitude 
and  phase  are  measured  to  yield  the  frequency  response  and 
phase  chracteristic  of  the  controlled  system. 

(3)  Transient  tests  are  used,  with  the  response 

system  determined  when  the  input  is  a  step  function;  an 

impulse  function,  or  a  more  general  transient  input.  The 
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system  is  characterized  in  the  time  domain.  ' 


The  first  method  of  determining  physical  characteristics 
is  the  dynamic  approach  to  modeling  physical  systems.  The 
second  method  describes  the  Bode  response  analysis,  and  the 
final  method  is  the  transient  response  analysis.  Each  of 
these  techniques  was  used  to  verify  some  aspect  of  the 
transfer  function  characteristics  of  the  flexible  robot 
manipulator  (DINO) . 

The  dynamic  approach  to  modeling  physical  systems  was 
used  in  conjunction  with  the  assumptions  that  the  system 
could  be  considered  a  lumped  parameter  system  to  find 
the  expected  form  of  the  transfer  function.  Bode  response 
analysis  was  used  to  experimentally  verify  the  results  of 
the  dynamic  approach,  and  (hopefully)  to  simplify  them. 

The  transient  response  method  was  used  to  find  the 
constants  associated  with  the  system  parameters  evaluated 
in  the  dynamic  approach. 

3 . 3  The  Dynamic  Approach 

The  horizontal  rotational  motion  of  the  robot  manipula¬ 
tor  shown  in  Figure  5.3.1  was  modeled  as  a  rotational 
mechanical  system.  Because  the  system  was  assumed  to  be  a 
lumped  parameter  system,  the  manipulator  was  divided  into 
a  finite  number  of  inertial  masses  connected  by  joints  which 
contributed  a  torsional  spring  constant  and  viscous  friction. 
Figure  3.3.2  shows  the  diagram  of  the  system.  Figure  5.3.5 
shows  a  network  representation  of  the  system. 


FIGURE  3.3.2  DIAGRAM  CP  ROBOT  MANIPULA* 


ACROSS 

VARIABLE 

DRIVER 


FIGURE  3.3.3  NETWORK  DIAS RAM  OF  ROBOT  MANIPULATOR 
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It  could  not  automatically  be  assumed  that  the  across 
variable  driver  was  constant.  Figure  3.3.4  shows  a 
diagram  of  the  mechanical  input.  The  following  analysis 
shows  that  the  across  variable  driver  was  not  a  function 
of  any  of  the  chosen  states.  Therefore,  Figure  3.3.3 
could  be  used  to  analyze  the  transfer  function  of  the 
system. 

Figure  3.3.4  shows  a  diagram  of  the  piston  input 

which  controls  motion  in  the  horizontal  plane.  The  viewer 

is  looking  down  on  the  input  system  from  the  positive 

z-axis.  The  piston,  whose  length  is  x,  is  considered  to 

be  a  constant  velocity  input  device.  With  this  assumption, 

d0 

,  or  the  time  rate  of  change  of  0  may  be  found.  for 

Figure  3.3.4  is  equal  to  “q  in  Figure  5.3.3 

The  Law  of  Cosines  states  that 
2  2  2 

x  *  A  +  B  -  2AB  cos ( 0 )  3-1 

where  from  Figure  5.3.4,  A  and  B  are  constant. 

The  time  derivative  of  5-1  yields 

2x^2.  -  2AB  s  in  ( 9  )  — 
dt  dt 

Given  3T  *  VQ  and 

2xVq  -  w0  2AB  sin(0) 

.  V-0  A 

WQ  AB  s  i  n  ( 9 ) 

The  Law  of  Sines  states  that 
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x  _  A 
sin0  ~  sTnTFT 

Therefore 

V0 

=  —  csc{f6) 


3-2 


Using  mathematical  modeling  techniques  and  the 
network  shown  in  Figure  3.3.3,  the  system  transfer  function 
was  derived  as  follows: 

Using  nodal  analysis 


where 

ri  "  ("o  '  “2)0 2  *  k2/s> 
r2  =  <i,2(-S'J2^ 

r3  =  (a2  ~  ^1^  ^1  +  ki/s) 

r4  =  VsJ1] 

Substituting  into  3-3  and  3-4  yields 

(“ o  -u2)(*2  +  k2/s)  =  W2CsJ2)  *  (a>2  -^1^0!  +  ^/s) 

(u»2  -  u1)(^1  +  Vs)  =  “ifsJi) 

Isolating  variables 

k  k  k 

«oC?2  *  k2/s>  •  “2C»1  *  »2  *  -hr  *  sj2>  ’ 

k  k 

0  =  -W2(@i  +  -i.)  +  uij  (0j  +  -j-  +  sJ1) 

u>l 

Solving  for  —  ,  the  transfer  function  is  found  to  be 


Equation  3-5  shows  that  the  expected  response  of  the 
system,  based  on  the  assumptions  discussed  previously,  was 


fourth  order.  If  the  assumptions  were  valid,  then  the 
experimental  analysis  which  follows  should  verify  equation 
3-5  with  data  taken  from  the  actual  system. 

3 . 4  Bode  Response  Analysis 

Using  dynamic  methods,  the  transfer  function  of  the 
model  was  found  automatically.  It  was  desired  to  verify 
the  analytical  findings  by  experimental  methods.  Using 
Bode  techniques,  it  was  hoped  that  the  model  could  be  further 
simplified  based  on  actual  data  obtained  from  the  system. 

An  input  to  a  linear  system  will  yield  an  output 
which  may  be  calculated  using  the  transfer  function.  Given 
a  linear  system,  an  analysis  of  the  response  of  the  system 
given  a  particular  input  may  be  helpful  in  discovering  the 
transfer  function  of  the  system.  If  the  input  is  a  variable- 
frequency  sine -wave  signal,  then  the  plot  of  the  ratio  of 
the  output  magnitude  to  the  input  magnitude  (in  decibels) 
versus  log  frequency  will  yield  a  Bode  plot.  This  technique 
is  especially  useful  for  determining  the  nature  of  the  poles 
and  zeros  of  a  transfer  function. 


_  J 


For  transfer  functions  of  linear  systems,  there  are 
four  characteristics  which  affect  the  Bode  plot.  ^ 


A  constant,  K 

Real  zeros  or  poles  of  the  form 

(s  *  zi>  °r  rs-^T 

A  zero  or  pole  at  the  origin:  s  or  i 

Complex  conjugate  zeros  or  poles: 

,  2  2s  1 

(s  +  2  t»ns  +  «n)  or  — o - ~ 

(s  +  2C<a  S  + 

'  n  n 

C  =  damping  ratio 

=  natural  frequency 

When  making  a  Bode  plot,  it  is  necessary  to  take  into 
account  the  effect  of  each  part  of  the  transfer  function. 

The  following  rules  are  used  to  plot  a  straight  line  approxi¬ 
mation  of  the  Bode  plot  of  a  system.  The  effect  of  a  case 
(1)  term  moves  the  entire  magnitude  plot  up  or  down  as  a 
function  of  20  log  K.  Terms  of  the  transfer  function  which 
contain  real  zeros  or  poles  as  in  case  (2)  have  certain  fre¬ 
quency  response  characteristics  as  shown  in  Figure  5.4.1. 

A  zero  or  pole  at  the  origin,  case  (3),  is  plotted  as  a 
straight  line  with  a  slope  of  20  dB/decade  for  a  zero  and 
-20  dB/decade  for  a  pole.  The  approximation  of  a  complex 
pole  or  zero  is  very  similar  to  that  of  a  real  pole  or  zero, 
except  for  high  frequencies.  The  case  is  shown  in  Figure 


Case  (1) 
Case  (2) 

Case  (3) 
Case  (4) 


uj  i  log  scale  l 
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Once  each  part  of  the  transfer  function  has  been 
plotted  as  a  straight  line  approximation,  the  complete 
gain  curve  may  be  approximated  by  adding  the  gains 
of  each  part  for  every  frequency.  This  does  not  yield 
the  final  Bode  plot,  though.  The  actual  Bode  plot 
representations  of  cases  (2)  and  (4)  are  not  the  same 
as  the  straight  line  approximations. 

There  are  rules  which  govern  the  correction  of 
asymptotic  Bode  gain  plots  to  get  the  actual  plot. 

For  case  (2),  gain  corrections  are  a  function  of  the 
location  of  the  pole  or  zero  as  shown  in  Figure  5.4.3. 

For  case  (4),  complex  conjugate  pairs  of  poles  or 
zeros,  the  difference  between  the  asymptotic  plot  and 
the  actual  curve  depends  on  the  value  of  f  ,  with  a 
variety  of  shapes  realizable  for  the  actual  curve. 

Figure  3.4.4  shows  how  a  Bode  plot  may  change  as  a  function 
of  . 

After  all  corrections  for  errors  in  asymptotic 
plotting  have  been  made,  the  resulting  graph  represents 
the  Bode  plot  of  the  system.  For  a  real  system,  the 
transfer  function  is  unknown  and  the  Bode  plot  is 
derived  experimentally  by  measuring  input  and  output 
magnitudes  at  various  frequencies.  Once  a  Bode  plot 
is  drawn  for  an  actual  system,  the  sequence  of  events 
leading  from  transfer  function  to  Bode  plot  described 
above  can  be  reversed  to  find  a  transfer  function  from 
the  frequency  response  characteristics  of  the  system. 


For  a  Bode  representation  of  DINO  to  be  obtained, 
a  sine -wave  input  and  a  method  of  reading  the  output 
had  to  be  devised.  Bang-bang  actuators  (like  those  on 
DINO)  do  not  readily  lend  themselves  as  input  devices 
for  Bode  analysis.  There  is  no  easy  way  to  vary  the 
amplitude  of  a  bang-bang  input  to  make  it  appear 
sinusoidal.  Therefore,  an  approximation  of  a  sine-wave 
must  be  considered. 

The  easiest  periodic  input  to  create  from  bang -bang 
actuators  is  a  square  wave,  as  shown  in  Figure  3.4.5  (a). 

A  series  analysis  would  show  that  a  square  wave  is  actually 
made  up  of  sine-waves  of  many  frequencies  superimposed  upon 
each  other.  If  a  square  wave  is  subjected  to  a  low-pass 
filtering  device  of  some  kind,  then  the  output  would  be 
a  closer  approximation  of  a  pure  sine  wave.  DINO's 
hydraulic  pistons  act  as  filtering  devices  which  eliminate 
many  of  the  overtones  associated  with  a  square  wave. 
Therefore,  the  assumption  that  a  square  wave  input  to  this 
system  approximates  a  sine  wave  is  not  unwarranted. 

There  is  a  problem  with  using  a  square  wave 
approximation  of  a  sine-wave  input.  This  problem  is 
reading  the  output  magnitude  when  the  frequency  of 
the  input  is  less  than  the  natural  frequency  of  the 
system.  The  output  is  then  complicated  with  transients 
which  cause  more  than  one  peak  to  occur  during  each 
excitation  period. 


Other  possible  inputs  were  also  considered.  One  was 


a  frequency  modulated  input  shown  in  Figure  3.4.5  (b) . 

The  input,  in  this  case,  would  consist  of  a  series  of 
short  pulses.  The  number  of  pulses  contained  within  each 
sampling  period  would  vary  as  a  constant  multiple  of  the 
magnitude  of  a  sampled  sine -wave.  The  number  of  sampling 
times  within  each  period  of  the  input  would  have  to  be  chosen 
carefully  so  that  there  would  be  enough  samples  to  approximate 
a  sine-wave.  Thus,  the  sampling  rate  would  have  to  be  much 
faster  than  the  desired  input  frequency.  The  problem  with 
this  type  of  approximation  was  that,  to  make  this  method 
effective,  the  pulse  width  of  each  pulse  within  the  series 
had  to  be  no  more  than  a  set  maximum  governed  by  the  desired 
frequency  input  and  the  number  of  samples  necessary  to  make 
the  approximation  valid.  The  problem  arose  from  the  fact 
that  the  system  would  not  follow  a  pulse  of  less  than  a 
minimum  fixed  time.  The  maximum  pulse  width  governed  by  the 
desired  frequency  input  and  sampling  rate  was  much  less  than 
the  minimum  fixed  time  needed  for  the  system  to  follow  a 
pulse  input.  The  net  result  was  that  the  system  mechanically 
ignored  the  entire  input. 

A  second  alternative  to  the  square  wave  approximation 
was  a  pulse  width  modulated  input  similar  to  that  shown 
in  Figure  3.4.5  (c) .  Similar  to  frequency  modulation,  the 
pulse  width  applied  to  the  system  within  a  sampling  period 
would  be  proportional  to  the  magnitude  of  a  sampled  sine-wave. 
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Again,  the  sampling  rate  would  be  much  faster  than  the 
desired  frequency  input.  This  method  had  the  same  problems 
as  the  frequency  method,  but  not  quite  as  severe.  The  system 
would  not  ignore  the  entire  input,  but  only  those  pulses 
which  were  less  than  the  minimum  width.  Thus,  the  actual 
input  to  the  system  would  appear  as  a  sine  wave  except  when 
the  pulse  width  was  too  narrow,  at  which  time  the  input  would 
appear  to  be  zero. 

The  final  method  considered  was  an  off-time  modulation. 

In  this  method,  a  very  fast  square  wave  would  be  input  where 
the  period  of  the  wave  would  be  equal  to  the  desired  sampling 
time.  In  order  to  vary  the  input  as  a  sine-wave,  one  half 
of  the  square  wave  would  be  reduced  in  width  by  a  constant 
multiple  of  a  sampled  sine-wave,  as  shown  in  Figure  3.4.5  (d)  . 
This  method  developed  the  same  problems  as  the  frequency  and 
pulse  width  methods.  To  get  the  system  to  react  properly 
(taking  the  minimum  pulse  width  into  account),  the  maximum 
frequency  available  was  too  low  for  the  purposes  of  analysis. 
An  additional  problem  arose  as  well.  If  a  square  wave  was 
input  from  the  computer  to  the  actuators,  the  system  would 
not  necessarily  remain  stationary  or  oscillate  about  a  fixed 
point.  In  the  DINO  system,  there  was  a  bias  to  the  right. 

This  meant  that  when  the  piston  controlling  horizontal 
motion  was  instructed  to  push  the  manipulator  to  the  right, 
it  always  moved  considerably  farther  than  when  it  was 
instructed  to  pull  the  manipulator  to  the  left  for  the 
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same  amount  of  time.  Therefore,  when  the  square  wave  was 
complete  on  both  halves  of  the  sampling  period,  the  system 
would  not  remain  stationary,  but  would  move  to  the  right. 

This  drift  would  greatly  hamper  the  analysis  of  the  output. 

The  square  wave  approximation  was  best  suited 
for  the  purposes  of  this  project.  It  could  be  used  to  evaluate 
high  frequency  inputs  which  the  others  could  not.  No  digital 
sampling  was  necessary,  and  the  frequency  of  the  input  could 
be  varied  easily.  The  problem  associated  with  reading  the 
output  due  to  unwanted  transients  at  low  frequencies  could 
be  solved  by  picking  a  common  point  at  each  frequency  where 
the  magnitude  would  be  evaluated.  For  analysis,  the  maximum 
peak  was  used  as  the  magnitude  of  the  output  sine -wave  when 
there  was  more  than  one  peak. 

With  a  square  wave  input  from  the  computer,  it  was 
easy  to  measure  the  magnitude  and  the  frequency  of  the  input 
at  most  frequencies.  Measuring  the  mechanical  output  was 
more  difficult.  The  method  chosen  was  based  on  the  desires 
of  the  investigator  and  the  availability  of  measuring 
equipment . 

It  was  desired  to  measure  position,  velocity,  and 
acceleration  along  the  path  of  motion  in  the  horizontal  plane, 
with  the  Bode  output  of  velocity  as  the  main  objective.  The 
method  chosen  was  to  measure  acceleration  directly,  using  an 
accelerometer,  and  to  obtain  velocity  and  position  by  using 
real-time  analog  computer  integration. 
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An  accelerometer  was  mounted  on  the  end  effector  (hand) 
of  the  manipulator  at  right  angles  to  the  radial  line 
connecting  the  hand  and  the  axis  of  rotation  for  the 
horizontal  plane.  Its  purpose  was  to  measure  acceleration 
along  the  path  of  motion  in  the  horizontal  plane.  The  output 
of  the  accelerometer  was  input  into  an  analog  integrator 
to  get  velocity  along  the  path  of  motion.  The  velocity 
output  was  again  integrated  to  give  position  along  the  path 
of  motion  in  the  horizontal  plane. 

There  were  many  problems  in  obtaining  an  acceptable 
output.  The  output  of  the  accelerometer  was  plagued  with 
high  frequency.. noise  due  to  the  hydraulic  pump  vibrating 
through  the  frame.  The  velocity  and  position  output  were 
victims  of  analog  drift.  This  was  due  to  a  constant 
voltage  bias  output  from  the  accelerometer  while  the  accel¬ 
erometer  was  at  rest.  The  bias  was  easily  countered  by  an 
equal  but  opposite  constant  voltage  supplied  to  the  input 
of  the  analog  integrator.  The  problem  with  this  approach 
was  that  the  bias  voltage  output  from  the  accelerometer 
changed  as  a  function  of  the  position  of  the  end  effector 
with  respect  to  the  axis  of  rotation.  The  compensatory 
voltage  input  had  to  be  adjusted  manually  or  by  analog 
feedback.  The  feedback  approach  affected  the  output 
response  of  the  system  and  was  found  to  be  inferior  to 
manually  adjusting  the  constant  voltage  correction.  Manual 
adjustment  was  less  efficient,  but  it  yielded  more  acceptable 
output  data. 
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The  analog  drift  was  very  bad  for  the  position  output 
due  to  double  integration.  Because  of  the  difficulty  of 
interpretating  the  output,  the  position  Bode  plot  was  never 
investigated  in  any  detail.  On  the  other  hand,  the  velocity 
output  was  quite  adequate  for  examination.  Using  both 
methods  described  above  to  compensate  for  the  analog  drift, 

Bode  plots  were  obtained  for  velocity.  These  are  shown 
in  Figure  3.4.6  to  3.4.9. 

A  comparison  of  the  plots  showed  that  for  low 
frequencies,  the  method  of  countering  the  analog  drift  had 
little  influence  on  the  output.  For  high  frequencies,  though, 
the  feedback  method  of  compensating  for  the  analog  drift 
showed  some  undesired  filtering  characteristics. 

Bode  plots  were  also  made  of  acceleration.  As  shown 
by  Figures  3.4.10  and  3.4.11  these  were  not  as  helpful  as 
the  velocity  Bode  plots.  This  was  mainly  due  to  the  difficulty 
in  reading  the  magnitude  of  the  output  due  to  high  frequency 
noise  interference  from  the  hydraulic  pump. 

The  purpose  of  obtaining  Bode  plots  was  to  verify  the 
general  form  of  the  transfer  function  found  in  the  dynamic 
approach.  In  order  to  do  this,  the  knowledge  of  the 
relation  between  Bode  plots  and  root  locations  in  the  s- 
plane,  as  discussed  previously,  had  to  be  applied. 

A  model  will  not  match  perfectly  every  characteristic 
of  an  experimentally  derived  Bode  plot;  therefore,  it  was 
important  to  find  the  general  characteristics  of  the  Bode 
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plot  which  most  nearly  agreed  with  the  rules  governing 
the  model. 

The  first  step  in  the  analysis  was  to  choose  an 
approximate  analytical  Bode  curve  to  approximate  the 
experimental  curve.  Then  an  asymptotic  approximation 
of  the  analytical  Bode  plot  would  lead  to  the  transfer 
function.  The  experimental  Bode  plot  chosen  for  analysis 
was  that  shown  in  Figure  3.4.6.  Figure  3.4.12  shows  the 
analytical  Bode  curve  and  the  asymptotic  approximation 
drawn  through  the  data  points  of  Figure  5.4.6.  This 
plot  exhibits  the  following  characteristics:  The  final 
slope  of  the  Bode  plot  was  most  nearly  -40  dB/decade. 

The  prominent  resonant  frequency  occurred  at  approximately 
1.5  Hz  at  a  magnitude  of  approximately  4  dB  above  the  low- 
frequency  asymptote.  The  low  frequency  response  of  the 
system  indicated  that  there  were  no  poles  or  zeros  at  the 
origin,  and  that  the  gain  K  was  less  than  one. 

By  analysis  of  the  analytic  and  asymptotic  approximations 
as  shown  in  Figure  5.4.12,  it  was  found  that  a  single  complex 
pair  of  poles  of  the  form 

K _  2 

~1  ~  I  where  K<  u>“ 

s  ♦  i s  *  »  n 

n  n 

would  yield  Bode  plots  very  similar  to  those  found 
experimentally,  if  the  proper  values  of  C  and  <»n  were 
chosen . 

Because  of  inaccuracies  in  the  experimental  Bode  plots. 
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they  were  not  used  to  actually  determine  the  damping  ratio 
(T)  and  the  natural  frequency  (tun)  .  Truxal's  third 
general  method  of  determining  a  transfer  function,  transient 
response  analysis,  was  used  to  evaluate  the  constant  values 

r7i 

of  the  characteristic  equation.  L  J 
3 . 5  Modifying  the  Dynamic  Approach 

Before  discussing  the  transient  approach,  it  might  be 
helpful  to  explain  how  the  Bode  response  simplification  of 
the  dynamic  approach  can  be  explained  analytically.  In  the 
dynamic  approach,  the  system  was  assumed  to  be  made  up  of 
two  significant  inertial  masses.  If  this  assumption  were 
changed,  as  the  Bode  analysis  suggested,  then  only  one 
inertial  mass  would  satisfy  the  requirements  of  the  lumped 
parameter  system  analysis.  The  transfer  function  would  be 
derived  using  the  model  in  Figure  3.5.1.  The  derivation 
of  the  dynamic  transfer  function  with  the  new  model  is 
given  below: 

^1 

0~0  +  -g-)  ■  ^(sJ,) 

Therefore 

V61  *  -T>  *  Vh  *  -r  *  sJi> 


The  transfer 

6 

1 


1 

ou1  JT 
^0  2 


function  of  the  model  is 

V 

*1. 


J1 


3-6 
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This  analysis  shows  that,  with  the  new  assumption, 
the  characteristic  equation  for  velocity  was  of  second 
order.  If  the  zero  was  shown  to  be  much  farther  to  the 
left  in  the  s-plane  than  the  complex  poles,  then  for  the 
Bode  analysis  it  could  be  ignored.  This  is  shown  below: 

From  3-6 


=  2fu,  and 


1  _  .2 
37  ~  ^n 


Therefore 

ei  _  4fz  kl 


=  2  r  /rp7 


From  3-6  the  zero  is  at  s  + 


2  f 


If  u-n  is  assumed  to  be  large  and  is  small,  then  the 
zero  from  equation  3-6  will  be  far  to  the  left. 


3.6  Transient  Response  Analysis 


With  a  pure  second  order  system  as  the  model  of  the  plant 
transfer  function,  the  transient  response  approach  was  a 
convenient  method  of  obtaining  the  necessary  constants.  The 
transient  approach  taken  involved  programming  the  transfer 
function  of  the  model  of  the  system  on  an  analog  computer 
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as  shown  in  Figure  3.6.1.  The  desired  constants  of  damping 
ratio  and  natural  frequency  were  directly  controlled  by 
potentiometers,  so  that  they  could  be  varied  throughout  the 
analysis. 

A  unit  step  was  then  input  simultaneously  to  the 
actual  and  modeled  systems.  The  outputsof  both  systems 
were  displayed  on  an  oscilloscope,  as  shown  in  Figure 
3.6.2.  A  visual  comparison  was  made  and  the  potentio¬ 
meters  of  the  analog  program  model  were  adjusted  to  fine 
tune  the  model  output  to  closely  approximate  the  output  of 
the  actual  system.  In  this  way,  system  constants  were 
determined. 

3 . 7  Regions  of  Motion 

The  values  of  the  system  constants  did  not  remain 
constant  throughout  the  entire  range  of  motion.  Instead, 
they  varied  as  a  function  of  the  radial  distance  between 
the  manipulator  and  effector  and  the  axis  of  rotation. 

It  was  not  obvious  which  form  this  function  took,  but 
there  were  regions  of  motion  where  the  transfer  function 
remained  fairly  constant.  Assuming  that  the  compensation 
method  chosen  would  be  sufficiently  robust  to  compensate  for 
minor  changes  in  the  location  of  roots  of  the  characteristic 
equation,  regions  of  motion  were  defined  where  the  roots 
of  the  characteristic  equation  would  be  considered  constant. 
This  eliminated  the  need  to  define  governing  equations  to 
describe  how  the  roots  would  change  as  a  function  of  end 
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effector  positioning. 

There  were  two  major  regions  chosen  to  separate  the 
range  of  motion  of  the  manipulator.  The  first,  and  the  one 
which  most  closely  resembled  the  pure  second  order  model, 
was  the  fully  extended  region.  This  region  was  defined 
to  be  that  region  where  either  of  the  pistons  which 
controlled  the  shoulder  or  elbow  joints  was  extended 
outward  beyond  the  midpoint  of  its  scope.  Any  position 
which  was  not  fully  extended  was  considered  to  be  close- 
coupled.  Figure  1.2  shows  the  system  in  one  of  its 
close -coupled  positions.  Figure  3.3.1  shows  a  fully 
extended  position,  because  the  pistons  which  control 
the  motion  about  the  shoulder  hinge  are  extended  beyond  the 
midpoint  of  their  scope. 
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CHAPTER  FOUR 
COMPENSATOR  DESIGN 

The  goal  of  this  project  was  to  enhance  the  performance 
of  a  mechanical  robot  arm  driven  by  bang-bang  actuators. 
System  performance  was  only  inadequate  in  the  horizontal 
plane  of  motion,  so  it  was  this  motion  that  was  investigated. 
A  model  of  the  system  equations  of  motion  in  the  horizontal 
plane  was  derived  using  analytic  and  experimental  methods. 

The  transfer  function  took  the  following  form: 

K 

2  ■> 
s  +  2C«»s  +  <» 
n  n 

The  system  input,  as  discussed  earlier,  could  not 
automatically  be  considered  constant.  An  assumption 
about  the  nature  of  the  desired  input  had  to  be  made. 

Since  the  compensation  was  designed  to  be  deadbeat,  it 
would  be  completed  within  one  period  of  the  natural 
frequency.  With  this  in  mind,  it  was  possible  to  assume 
that  cosecant  (.0),  from  equation  3-d,wouid  be  constant. 
Therefore,  the  input  function  could  be  considered  constant. 

A  constant,  bang-bang  input  would  take  the  following  form: 

r  (  t )  =  u  ( t  - 1  j )  +  u  ( t  - 1 7 )  -  u  ( t  - 1 3 )  +  . 

Where  tj  <  t2  <  t5  <  ...  <  tn 

u(t)  is  a  constant  step  input  applied  for  t  >  0 
The  object  was  to  control  the  system  with  as  simple 
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an  input  as  possible.  The  least  complicated  input  was 

u ( t i  (a  constant  step  input).  Figure  4.1  shows  the  output 

of  a  typically  underdamped  system  with  u(t)  as  the  input. 

The  sample  system  dynamics  were  chosen  to  be 

Y  (s )  =  100 _ 

R(s)  s2  +  s  +  100 

As  the  case  with  flexible  robot  manipulators,  the  system 
was  very  underdamped,  and  a  simple  input,  u(.t),  would  not 
suffice  as  a  controlling  input. 

The  second  least  complicated  input  was  u(t)  -  u(t-t^). 
This  was  undesirable  as  a  control  because,  assuming  tj 
was  finite,  the  steady  state  value  of  the  output  was  :ero. 

The  third  least  complicated  input  was  u(t)  -  ult-t^)  + 
u(t-tj).  This  input  would  yield  the  proper  steady-state 
value  for  a  control,  and  it  also  allowed  for  tj  and  t_>  to 
be  varied  independently.  It  was  supposed  that  this  control 
could  be  manipulated  to  compensate  the  system. 

The  first  step  to  evaluate  a  compensation  strategy 
based  on  the  control  above,  was  to  look  at  system  response 
to  an  input  of  r(t)  =  u(t)  -  uft-tj). 


Vis)  = 


R(  s) 


assume  K  =  w  ~ 
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Take  inverse  Laplace  transform  of  4-1 


v(t) 


=  l  + 


1  -cJt  .  ,  .  , ,( 

e  sm(u>,t  -  0) 


u(t) 


\fl-i2 

I-1  +7i=T^e^(t"tl)sin(&d(t'ti)  "  u(;t'ti-1  4-2 


where  6  *  f  cu 

n 

“d  ■  ■  * 2 

*  .  tan  (f-XllL , 
-  ^ 


For  the  fastest  response,  the  control  was  to  become 

'j 

effective  during  the  first  period,  t<(~).  Figure  4.2 

"n 

shows  how  the  sample  system  reacted  to  varying  t^.  The 
most  significant  point  of  each  curve  was  t  ,  the  time  of  the 
first  peak  overshoot.  It  was  at  this  point  that  the  system 
had  an  acceleration  of  zero  and  constant  velocity.  If,  at 
this  point,  the  velocity  was  equal  to  the  steady-state 
velocity,  then  a  step  input  u(t-t7),  where  t7  =  t  ,  it  was 
believed,  would  maintain  this  velocity  with  zero  acceleration. 
Thus,  a  compensator  with  a  control  of  u(t)  -  u(t-t^)  +  u(t-t-,)» 
where  t ^  =  t  and  y C 1 2 ^  equaled  the  steady  state  velocity, 
would  bring  the  system  to  steady  state  velocity  as  fast  as 
possible  with  no  overshoot.  A  mathematical  analysis  showed 
the  following: 

To  find  t  ,  assume  t  >  t^  in  equation  4-2. 

Thus 


V  (t )  =  Ae  ~0t  sinCoOdt  -  rf)  -  Ae  ’ 1 1 1  s  in  Ud  (t -t  1 )  -  «*)  4-3 

1 


where  A 


i/l  *  i 


7 


INPUT  EXCITATION 
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Then  take  the  time  derivative  of  4-5. 


dyU) 

dt 


"iAe  ***  cos(i»  t  -  t>)  -  tfAe  ot  sin(»,t  -  <t>)  4-4 

a  U  Cl 

“jAe  C^cos  f  »d(  t-t^j -$)  +  cfAe  1  ’ 1 1  ^  s  in  ( u>d  f  t  - 1 1 )  -  <6 ) 


Set  equation  4-4  equal  to  zero  find  t  . 

To  do  this 

Assume  =  constant 

and  expand  sin  and  cos  terms 

cos  ( <*  -  /?)  =  cos  a  cos/?  +  s  in  a  sin/? 
sin(a  -  /?  I  *  sin  a  cos/?  -  cos  «  sin/3 


then  solve  for  t, 


tan 


- 1 


,.cos  ( <t  ) -arts  in ( ) +  ■** .erft  1  (  <».t ,  -hJ  )  -Kreotl  sin(  <«  t ,  -mi  )  ”1 
4  4  a  >  a  ! 


rfti 


i  <0^3 in ( d  )-<3"cos  ( a  1 3in(  f  *<t  1  cos  (  t  ^  +<a  ) 


4- 


•d 


Thus  tp ,  given  the  damping  ratio  and  the  natural 
frequency  of  the  system,  is  a  function  of  t^.  Substituting 
t|  and  tp  into  equation  4-3  gives  the  magnitude  of  the 
response  at  tp.  A  digital  program  which  varied  t^  would  be 
able  to  find  tp,  where  y(tp)  was  equal  to  the  steady-state 
velocity.  Therefore,  given  the  damping  ratio  and  the 
natural  frequency,  t^  and  t?  could  be  found  for  the  input 
which  would  act  as  a  deadbeat  compensator.  Figure  4.3 
shows  that  the  implementation  of  this  control  to  the  sample 
system  yielded  a  deadbeat  response. 


FIGURE  4.3  SAMPLE  SYSTEM  RESPONSE  USING 
_  THE  DEADBEAT  COMPENSATION  TECHNIQUE 
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CHAPTER  FIVE 

SENSITIVITY  OF  DEADBEAT  CONTROLLER 

The  purpose  of  this  chapter  is  to  examine  the 
sensitivity  of  the  deadbeat  controller  to  changes  in  the 
system  parameters.  The  deadbeat  controller  relies  heavily 
on  the  knowledge  of  system  parameters.  If  the  system  is 
second  order  and  bang-bang  actuated,  then  it  was  shown 
that  a  simple  deadbeat  controller  may  be  programmed  which 
will  compensate  the  system  if  the  system  parameters  of 
damping  ratio  and  natural  frequency  are  known.  What  will 
happen,  though,'  if  the  system  parameters  vary  from  the  modeled 
values  from  which  the  deadbeat  compensator  was  derived?  The 
effect  of  changing  system  parameters  on  the  ability  of  a 
compensator  to  control  the  system  is  known  as  sensitivity. 

Deadbeat  controllers  have  a  reputation  for  being  very 
sensitive  to  parameter  changes.  By  varying  the  damping 
ratio  and  natural  frequency  of  the  sample  system  without 
changing  the  compensator,  the  sensitivity  of  this  deadbeat 
technique  can  be  evaluated. 

Figures  5.1  through  5.6  show  how  the  output  is  affected 
by  changing  the  damping  ratio  and  the  natural  frequency 
while  keeping  the  compensating  times  constant.  It  can  be 
seen  that  the  output  is  indeed  affected  by  parameter  changes, 
but  system  performance  is  still  improved,  as  compared  with 
the  uncompensated  system. 


FIGURE  5.4  SAMPLE  SYSTEM  RESPONSE  WITH  THE 
DAMPING  RATIO  INCREASED  BY  20* 


<CUZmHSOUJ 


FIGURE  5.6  SAMPLE  SYSTEM  RESPONSE  MITH  THE 

DAMPING  RATIO  AND  NATURAL  FREQUENCY 
BOTH  INCREASED  BY  20k 
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In  Chapter  Three  it  was  decided  to  choose  regions 
of  motion  where  the  roots  of  the  characteristic  equation 
would  be  considered  constant.  This  decision  was  based 
on  the  assumption  that  the  compensation  technique  which 
would  be  developed  would  be  relatively  insensitive  to 
minor  parameter  changes  exhibited  within  the  region. 

The  study  of  sensitivity  in  this  section  has  shown  that 
this  assumption  was  valid. 

The  effectiveness  of  the  deadbeat  controller  also 
relies  heavily  on  the  ability  of  the  computer  to  precisely 
measure  the  control  times,  t^  and  t7.  The  times,  t^  and 
t2,  are  the  input  times  discussed  in  Chapter  Four.  If 
the  computer  was  not  able  to  achieve  good  resolution  of  t ^ 
and  t7,  then  the  compensation  would  be  adversely  affected. 
Figures  5.7  through  5.9  show  how  the  output  of  the  system 
is  affected  by  varying  resolution  of  t^  and  t7.  Again, 
it  can  be  seen  that  the  output  is  affected  by  changing 
resolution  of  t^  and  t^ . 

The  actual  resolution  available  for  this  project 
was  dependent  on  how  fast  the  microcomputer  could  run  the 
controlling  programs.  In  the  programs  which  controlled  the 
system,  time  was  measured  using  program  loops  of  the  form 
100  FOR  I  =  1  TO  A 
110  NEXT  I 

The  resolution  was  a  function  of  how  fast  the  computer 
could  run  the  loop  when  A  *  1.  It  was  found,  by  using 


FIGURE  5.8  SAMPLE  SYSTEM  RESPONSE  MITH  TIME 

RESOLUTION  TO  MITMIN  .81  SECONDS 


RESOLUTION  TO  WITHIN  .1  SECONDS 


the  "SQBODE"  program  found  in  Appendix  C  and  a  period 
measuring  device, that  resolution  of  approximately  1.2 
milliseconds  could  be  achieved.  Figure  5.7  shows  that 
this  resolution  is  quite  sufficient. 
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CHAPTER  SIX 
IMPLEMENTATION 

This  chapter  introduces  the  programs  which  were  used 
to  compensate  the  horizontal  motion  of  the  system.  The 
practical  problems  associated  with  implementing  the 
theoretical  compensation  technique  developed  in  Chapter 
Four  on  the  actual  system  are  also  discussed.  Finally, 
this  chapter  studies  the  effectiveness  of  the  compensator. 

6 . 1  Computer  Programs 

For  testing  the  control  algorithm,  the  program 
"CONTROL,”  shown  in  Appendix  A,  was  used.  This  program 
allowed  the  control  times  discussed  in  Chapter  Four  to 
be  changed.  The  investigator  could  also  input  the 
direction  of  motion  to  be  tested.  The  program  only 
controlled  motion  in  the  horizontal  plane.  Different 
orientations  of  the  shoulder,  elbow  and  wrist  joints 
had  to  be  chosen  and  prepared  manually  before  the 
program  was  run. 

A  more  powerful  program  "TEACH,"  shown  in  Appendix 
B,  was  not  used  for  testing,  but  for  demonstration.  This 
program  allowed  the  user  to  input,  or  teach,  a  complete 
routine  to  the  system.  This  program  would  then  repeat 


the 
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the  routine  as  many  times  as  instructed  using  the 
compensation  technique  of  Chapter  Four.  The  program 
takes  into  account  the  region  of  motion  to  be  compensated. 

Only  the  motion  in  the  horizontal  plane  was  compensated. 

6.2  Practical  Implementation 

In  Chapters  Four  and  Five,  it  was  shown  that  the 
deadbeat  compensator  for  second  order  systems  controlled 
by  bang -bang  actuators  was  an  effective  method  of 
compensating  highly  underdamped  second  order  systems. 
Implementation  of  the  theory  would  work  as  long  as  the  model 
used  to  simulate  the  system  was  an  accurate  estimation  of 
the  actual  system.  For  the  fully  extended  case,  as  defined 
previously,  the  control  was  implemented  per  theory,  with  the 
expectation  of  the  following  change  to  the  controlling  times. 
The  input  pulse  widths  calculated  using  the  deadbeat  criteria 
were  not  the  same  times  used  to  control  the  horizontal 
motion  of  the  actual  system.  This  was  due  to  the  necessity 
to  take  into  account  a  mechanical  time  lag  not  accounted  for 
in  the  model.  This  time  lag,  due  to  a  signal  delay  at 
the  actuator  and  pistons  which  controlled  motion  in  the 
horizontal  plane,  was  simply  added  to  the  pulse  width  times 
to  make  the  compensation  effective.  The  improvement  in  system 
performance  was  substantial  after  this  time  lag  was  considered. 
The  strip  chart  recordings  in  Figures  6.2.1  to  6.2.4  show  the 
output  with  and  without  compensation. 
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The  data  for  the  strip  chart  recordings  was  taken 
at  the  center  of  the  region  to  be  compensated.  It  was  found 
that  system  improvement  for  the  fully  extended  region  was 
substantial  throughout  the  entire  region  when  using  the 
set  of  control  values  derived  for  the  center  of  the  region. 

The  values  used  for  the  fully  extended  region  were  found  to 
be  mostly  ineffective  when  applied  to  the  close -coupled 
region,  thus  making  it  necessary  to  have  a  different  set 
of  control  values  for  each  region  of  motion. 

The  close -coupled  case  was  also  recorded  by  strip  chart. 
(Figures  6.2.3  and  6.2.4)  Again,  the  output  was  improved 
with  compensation,  but  the  compensated  response  was  not 
perfectly  deadbeat.  A  reason  suspected  for  this  situation 
was  the  breakdown  of  the  initial  linear  assumptions  of  the 
model.  Greater  sensitivity  due  to  slight  parameter  variations 
of  the  end  effector  positioning  in  the  close -coupled  region 
was  also  found  to  be  a  factor  which  influenced  the  imperfect 
response . 

The  simplified  linear  model  most  nearly  matched  the 
actual  system  in  the  fully  extended  region,  and  it  was  in 
this  region  that  compensated  system  response  was  most  nearly 
deadbeat.  Nevertheless,  as  shown  in  Figure  6.2.  a  theoretical 
deadbeat  rerponse  was  not  completely  achieved.  There  were 
three  possible  contributing  reasons  for  the  minor  differences 
which  were  observed  between  the  actual  and  theoretical 
responses.  The  first  reason  was  that  the  model  was  not 
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completely  accurate  due  to  faulty  linearity  and  lumped 
system  assumptions.  A  second  explanation  for  the  deviation 
of  the  fully  extended  response  from  theoretical  deadbeat 
response  was  that  the  assumption  of  a  constant  input  was 
faulty.  This  was  not  considered  a  major  factor  because, 
as  discussed  earlier,  the  angular  displacement  during  the 
time  of  the  control  was  so  small  that  the  input  excitation 
could  be  considered  constant.  The  last,  and  most  probable, 
reason  for  the  imperfect  response  was  the  affect  of  the 
system  zero  shown  in  equation  3-6.  This  zero  had  been 
assumed  to  be  far  enough  to  the  left  to  be  overlooked. 

The  deadbeat  control  algorithm  was  developed  without 
consideration  of  this  zero. 
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CHAPTER  SEVEN 
FURTHER  IMPROVEMENTS 

System  improvement  was  significant  throughout  the 
range  of  motion  of  the  manipulator,  but  the  performance 
of  the  compensation  technique  could  be  improved  further. 

In  the  opinion  of  the  investigator,  the  assumptions  made 
in  the  process  of  determining  the  transfer  function  were 
both  helpful  and  valid.  To  make  the  model  more  complicated 
would  not  have  facilitated  development  of  a  more  cost- 
effective  compensation  technique.  The  system  was  controlled 
by  a  simple  input;  therefore,  a  simple  model  and  a  simple 
compensator  were  warranted. 

There  are  ways  to  improve  upon  the  results  of  this 
project.  The  controlling  program  used  fixed  pulse  widths 
to  control  the  manipulator  within  a  given,  predefined 
region.  This  meant  that  it  was  not  adaptable  to  changing 
system  parameters.  A  more  powerful  type  of  control  would 
be  to  give  the  computer  the  ability  to  change  its 
compensating  algorithms  based  on  changes  in  system  para¬ 
meters.  This  is  known  as  adaptive  control.  If  a  compensator 
is  not  adaptive,  then  every  time  a  parameter  is  significantly 
changed,  such  as  the  end  effector  load,  the  compensator  will 
no  longer  be  effective. 

Adaptive  control  relies  on  state  feedback  information 
to  compensate  the  system.  For  this  system,  there  are  two 
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approaches  which  could  lead  to  an  effective  adaptive  controller, 
assuming  that  the  general  method  of  control  would  remain 
the  same.  In  each  case,  a  finite  number  of  states  would  have 
to  be  fed  back  to  the  computer  so  that  an  algorithm  could  be 
applied  to  vary  the  compensation  of  the  system. 

The  first  approach  would  be  to  develop  a  more  accurate 
model  of  the  system  which  would  take  into  account  as  many 
states  as  possible,  such  as  oil  pressure,  air  pressure, 
oil  temperature,  and  end  effector  load.  It  would  then  be 
necessary  to  feed  back  these  states  so  that  the  computer 
could  evaluate  the  controlling  times  before  activating  the 
deadbeat  controller.  All  of  these  calculations  would  be 
completed,  and  the  control  times  set,  before  the  compensation 
would  take  effect.  The  first  approach  would  use  a  decision 
process  which  would  be  entirely  outside  the  actual  time 
of  control. 

The  second  approach  for  developing  an  effective  adaptive 
controller  would  be  to  put  all  of  the  decision  processes 
inside  the  time  of  control.  In  this  case,  t^  and  t,  from 
Chapter  Four  would  be  considered  functions  of  the  states 
associated  with  motion,  such  as  position,  velocity,  and 
acceleration.  The  feedback  then  would  be  used  in 
real  time,  after  the  deadbeat  controller  had  been  activated, 
but  before  the  first  control  time,  t^.  An  algorithm  would 
use  the  feedback  states  to  tell  the  computer  when  t^  and  t? 
should  occur. 
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If  a  more  complicated  controlling  technique  is  desired, 
then  an  adaptive  controller  based  on  a  new  compensation 
technique  is  possible.  The  system  can  be  compensated  by 
controlling  a  more  complicated  input  pulse  train,  but  as 
the  pulse  train  becomes  more  complicated,  so  does  the  mathe¬ 
matical  analysis  and,  more  importantly,  so  does  the  physical 
implementation. 

Non-linear  digital  control  is  also  possible.  This 
approach  would  be  based  on  an  assumption  of  system  non¬ 
linearity  due  to  saturation  when  pulse  width  exceeds 
sample  time.  The  analysis  for  this  approach  is  very 
complicated,  and  the  literature  which  deals  with  this  topic 
is  sparse  and  somewhat  dated. 
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appendix  a 


Compensator  Test  Program 
"CONTROL” 


This 


program  was  used  to  test  the  compensat 
The  control  times  are  user  inputs. 


technique . 


APPENDIX  A 


b: CONTROL. BAS 


5  A7I  =  1 
10  NUMO'i  =  0 
20  NUM1%  =  1 
30  CALL  PORTS 
35  CALL  CLRALL 

40  PRINT  'ENTER  DIRECTION  1  OR  2* 
50  INPUT  D X 
60  PRINT  'ENTER  Tl' 

70  INPUT  L 
SO  PRINT  'ENTER  T2' 

‘>0  INPUT  M 
95  PRINT  'ENTER  N' 


96  : 

INPUT  N 

97  PRINT  'ENTER  T3' 

98  : 

INPUT  0 

99  PRINT  'ENTER  T4 

too 

INPUT  P 

101 

CALL  ENABLE (NUM1%) 

110 

CALL  AXIS ( A%  r D%) 

120 

GOSUB  180 

130 

CALL  AXIS <  A% , NUMO% ) 

140 

GOSUB  200 

• 

L  50 

CALL  AXIS 

(  A7. ,  D %  1 

151 

GOSUB  300 

153 

CALL  AXIS 

( A7.,NUM0%) 

154 

GOSUB  400 

155 

r  TLl  AX  t  S ( A%  f  D%  > 

160 

oCSUB  500 

163 

CALL  AXIS 

( A%  f NUM0% ) 

1 70 

GOTO  40 

175 

END 

130 

FOR  I  =  1 

TO  L 

190 

NEXT  I 

1 95 

RETURN 

200 

FOR  J  =  1 

TO  M 

210 

NEXT  J 

220 

RETURN 

300 

FOR  1=1 

TO  N 

3 1 0 

NEXT  I 

320 

RETURN 

400 

FOR  I  =  1 

TO  0 

410 

NEXT  I 

420 

RETURN 

500 

FOR  I  =  1 

TO  P 

520 

NEXT  I 

530 

RETURN 
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APPENDIX  B 


Compensator  Deomonstration  Program 
"TEACH" 

This  program  implements  the  compensation  technique  in  a 
program  designed  for  practical  application.  There  are  two 
options  available.  The  user  may  choose  a  preset  routine, 
which  has  eighteen  positions,  or  may  teach  the  manipulator 
a  new  routine  to  be  repeated  by  the  computer. 
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TEACH. BAS 


5-2-83 


100 

REM 

1 10 

REM 

L  20 

REM 

130 

REM 

150 

REM 

160 

REM 

170 

REM 

190 

REM 

200 

REM 

210 

REM 

220 

REM 

230 

REM 

240 

REM 

250 

REM 

260 

REM 

270 

REM 

^>7cj 

290 

295 

296 
.500 
310 
320 

324 

325 
330 
340 
350 
360 
370 
330 
390 
400 
405 


*******  ***************************  ******  *********************  ** 
THIS  PROGRAM  EXECUTES  A  TEACH  ROUTINE  FOR  DINO. 

CREATED  BY  TOM  LOOKE:  2  APRIL  1983 
*************************************************************** 


******************************************** 
*  * 

*  INITIAL  VARIABLE  REGION  * 

*  * 

U/  \A/  vLf  'V  Vi t  W  ^  ^  'V  <V  'if  ^  'if  'if  'if  'ib  ^  ^  ib  ib  ^  ib  lb  lb  J/  >b  b  U/  |b  i if  4/  ib  |b  \b  ib  ^  lb  ib  \lf  lb 


DIM  AX ( 1 00 ) 
DIM  B% ( 100 ) 
DIM  CX(IOO) 
DIM  EX  <  100 ) 
DIM  FT' (100) 
AX  IX  =  1 
0X2%  =  2 
AX37.  =  3 
AX 4%  =  4 
0X57.  =  5 
DIR17.  =  1 
DIR2X  =  2 
CLR7.  =  0 

11  =0 

12  =  0 
13  =  0 
IT  =  0 
17.  =  0 
XI  =  0 


410 

4  20 
430 
440 
450 

480  REM 
490  REM 

500  REM 

501  REM 

502 

503 

504 

505 

506 

507 

5  1 0 


SETX  =  1 
X5  =  0 
R  -  0 
ST  =  0 
REG  =  0 


***************  MAIN  PROGRAM  *************** 

CALL  PORTS 
CALL  CLRALL 
CALL  ENABLE (SETX) 

PRINT  * DO  YOU  WONT  I HE  SAVED  ROUTINE* 

INPUT  R2$ 

IF  R2*  =  ’YES*  THEN  600 

PRINT  *I40W  MANY  POSITIONS  ARE.  IN  THE  ROUTINE* 
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520 

INPUT  N 

530 

GOSIJB  1070 

532 

PRINT  ’DO  YOU  WANT  THE  HORIZONTAL 

CONTROL  REMOVED 

534 

INPUT  Rl$ 

535 

IF  Rli  =  ’YES*  THEN  538 

536 

REG  =  0 

537 

GOTO  540 

538 

REG  =  1 

540 

PRINT  ‘HOW  MANY  TIMES  DO  YOU  WANT 

THE  ROUTINE  RUN 

541 

INPUT  TX 

542 

FOR  0  =  1  TO  TX 

543 

GOSUB  2000 

544 

NEXT  0 

545 

PRINT  'WOULD  YOU  LIKE  THE  ROUTINE 

RUN  AGAIN* 

546 

INPUT  U* 

547 

IF  U*  =  'YES'  THEN  532 

550 

PRINT  'WOULD  YOU  LIKE  TO  RUN  A  DIFFERENT  ROUTINE* 

552 

INPUT  T $ 

554 

IF  T*  =  'YES'  THEN  510 

555 

REM 

553 

REM 

560 

REM 

**********  SAVED  ROUTINE  **********  'it******* 

600 

A%  <  1  ) 

2= 

91 

601 

A%(  1  ) 

- 

91 

602 

A“:<2) 

91 

603 

A%  ( 3 ) 

= 

230 

604 

A7.  <  4 ) 

230 

605 

A7.(5) 

= 

230 

606 

A%(6) 

?1 

607 

A%  <  7  ) 

= 

91 

608 

A  7.(3) 

- 

91 

609 

A  %  <  9  > 

T= 

230 

610 

a;:<  to) 

=  230 

6 1 1 

AZ<  1 .1 ) 

=  230 

612 

A7.(  12) 

=  230 

613 

A7.(  13) 

=  230 

614 

A% (14) 

=  230 

6.15 

A %( 15) 

»  170 

6 1 6 

A%( 16) 

*  170 

6 1 7 

A%( 17) 

=  170 

6.13 

A%( 13) 

=  91 

651 

B%  (  1  ) 

101 

652 

b;:<2) 

== 

101 

653 

E<7.(3) 

= 

101 

654 

B%  ( 4 ) 

240 

655 

B7.(5> 

= 

240 

656 

B7.  (  6  ) 

:= 

10 .1 

657 

B%  (  7 ) 

101 

658 

BZ  <  B  :> 

101 

659 

BZ  ( 9 ) 

101 

660 

B7.(  10) 

=  20 
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B  X  (11) 

=  45 

BX< 12) 

=  230 

BX< 13) 

=  40 

B%( 14) 

=  230 

BX< 15) 

=  230 

BX< 16) 

=  60 

B%( 17) 

=  60 

BX  < 13 ) 

=  101 

CX  ( 1 ) 

=  140 

CX<2) 

=  140 

CX<3> 

=  140 

CX  ( 4 ) 

=  213 

CX  ( 5 ) 

=  240 

C  X  ( 6 ) 

=  240 

CX  <  7 ) 

=  140 

C%  ( 8 ) 

=  140 

C7.  ( 9 ) 

=  140 

C%< 10) 

=  238 

C% ( 1 1 ) 

=  100 

CX( 12) 

=  213 

C% ( 13 ) 

=  213 

CX( 14 ) 

=  100 

CX( 15) 

=  100 

CX< 16) 

=  100 

CX< 17) 

=  30 

CX ( 18) 

=  140 

EX  ( 1 ) 

=  1 

EX  (2) 

— 

EX  ( 3 ) 

—  2 

EX<4) 

=  1 

EX  ( 5  > 

=  1 

EX  <  6 ) 

=  1 

EX  ( 7 ) 

=  1 

EX  ( 8 ) 

—  n 

EX  ( 9 ) 

=  '? 

EX( 10) 

=  1 

EX  (1.1 ) 

=  1 

EX( 12) 

—  n 

EX< 13) 

~  n 

EX ( 14) 

—  n 

EX< 15) 

—  n 

EX( 16) 

—  n 

EX< 17) 

=  1 

EX< 19) 

—  n 

FX(  1 ) 

=  10000 

FX  ( 2 ) 

=  1000 

FX  <  3 ) 

=  0 

FX<4) 

=  0 

FX  <  5 ) 

=  0 

FX  <  6 ) 

=  0 

FX  <  7 ) 

=  5000 
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308 

F% ( 8 )  = 

0 

809 

F%(9>  = 

0 

810 

FX<10>  = 

0 

811 

F% (11)  = 

0 

312 

FX<  12)  = 

0 

8.13 

FX<13)  = 

0 

314 

F  X  <  .14)  = 

0 

315 

F%< 15)  = 

0 

816 

FX< 16)  = 

0 

817 

F%< 17 )  = 

0 

313 

FX(18)  = 

0 

850 

N  =  13 

900 

GOTO  532 

910 

END 

950 

REM 

960  REM 
970  REM 


980  REM 
990  REM 
1000  REM 
1010  REM 
1020  REM 
1030  REM 
1040  REM 
1050  REM 


********************************************* 
* 

*  '•  TEACH  ROUTINE 

*  * 


1060 

REM 

1070 

1080 

1090 

1100 

1110 

1120 

1130 

1140 

1150 

1900 

REM 

1910 

REM 

1920 

REM 

1930 

REM 

19  40 

REM 

.1  950 

REM 

1960 

REM 

1970 

REM 

1980 

REM 

2000 

2001 

2002 

2003 

2004 

2005 

2006 

FOR  I  •-  l  TO  N 

PRINT  'PLACE  ROBOT  IN  POSITION  *  ,*  I 
PRINT  'THEN  PRESS  THE  ZERO  KEY  AND  RETURN' 
INPUT  Y 

CALL  ADC08 ( AX1X  » A% ( I >  ) 

CALL  ADC08 ( AX2X » B%  <  I )  > 

CALL  ADC08  <  AX3%  t C%  < I )  ) 

NEXT  I 
RETURN 


******************************************** 
*  * 

*  REPEAT  ROUTINE  * 

*  * 
******************************************** 


FOR  I  =  1  TO  N 

11  =  0 

12  =  0 
13  =  0 
IT  =  0 
Z%  =  0 
XI  =  0 
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3115 

3120 

3130 

3140 

3130 

3160 

3170 

3130  REM 
3132  REM 
3184  REM 
3186  REM 
3188  REM 
3190  REM 
3192  REM 
3194  REM 
3196  REM 
3200 
3210 
3215 
3220 
3230 
3240 
3250 
3260 
3270 

3280  REM 
3282  REM 
3284  REM 


IF  EX  <  -127  THEN  E%  *  EX  +  255 
IF  ABS ( EX  -  BX < I )  )  <  5  THEN  3500 
IF  EX  >  BX  <  I  >  THEN  3160 
CALL  AXIS ( AX2X  r DIR2X ) 

RETURN 

CALL  AXIS <  AX2X  r DIR1X ) 

RETURN 


^  d.  d.  d*  d.  u»  ^  ^  ^  -jl.  vu  li*  Uj  d/  ^  . L/  df  ^  df  ^  V If  .1.  uU  ^  (jb  .J/  df  td  d.  d  J,  d  <//  d. 

%  * 

*  MOVE  AXIS  THREE  TO  DESIRED  POSITION  * 

*  * 

\ I.  df  «L  d  d  d  'll  1*1  ill  di  d  'll  .U  '  Li  d  d  d.  lb  lb  'll  d.  d#  dl  d  df  d  d.  d.  dl  dl  d.  vb  di  d.  'll  d.  vb  Vll  d.  '  1 1  d/  d  1*1  dl 

f  ^  ^  J|C  /fi  ^  /*  ^  ^  r|\  /ft  /fl  9  9  ^  ^  ^  ^  Jp  Ifk  f  ^  f  4»  1^  <n  4^  'T'  o'  ^  f  * 


CALL  ADC08 ( AX3X  t F% ) 

IF  FX  >  127  THEN  F%  *  FX  -  255 
IF  FX  <  -127  THEN  FX  =  FX  +  255 
IF  ABS < FX  -  C% < I )  )  <  5  THEN  3600 
IF  FX  >  CX(I)  THEN  3260 
CALL  AXIS ( AX3X . DIR2X ) 

RETURN 

CALL  AXIS< AX3X r DIR1X ) 

RETURN 


^  i^i  ^p  i ^p  ^p  ^  |^p  ^  ^  ^  y^p  |^p  y^p  p|^  p^p  \^p  pj^  p|^  p^  ^p  pj^  <^p  ^  p^p  p^p  ^  v|^  p^  y^p  ^  p^  '|^  p^p  p^ 


I 

I 

I 


3286  REM 

3288  REM 

3290  REM 

3292  REM 

3294  REM 

3296  REM 

8300 

3305 

3310 

3315 

3320 

3340 

3350 

3360 

3365 

3370 

3380 

3390 

3395 

3397 

3400  REM 
3410  REM 
3470  REM 


*  * 

*  MOVE  AXIS  ONE  TO  DESIRED  POSITION  * 

#  * 
*(t  lie  lie  lie  lie  iK  iji  lie  It  lie  <lt  i)t  lie  lie  lie  lie  lie  lie  lie  lie  lie  lit  i(e  lie  Jie  lie  lie  lie  lie  lie  He  lie  lie  lie  lie  i(e  ije  i(£  lie  i(e  lie  lie  lie 


CALL  ADC08<  AX17.,DX) 

IF  ST  =  1  THEN  3395 
IF  DX  >  127  THEN  DX  =  BX  -  255 
IF  BX  <  -127  THEN  D%  =  DX  +  255 
IF  ABS ( DX  -  AX  ( I ) )  <  15  THEN  3900 
IF  DX  >  AX < I )  THEN  3370 
CALL  AX IS < AX 1 X r D IR1 % ) 

X5  =  1 
RETURN 

CALL  AX  IS  ( AX1X » DIR2X ) 

X5  =  2 
RETURN 

CALL  AXIS( AXlXt CLRX) 

RETURN 


He**#**##****#  NULL  AXIS  TWO  ft##*###**#**** 


I 
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3480 

REM 

3500 

CALL  AXIS(AX2X,CLRX> 

3510 

IF  12  =  1  THEN  3550 

3520 

12  =  1 

3530 

IT  =  IT  +  1 

3550 

RETURN 

3530 

REM 

3570 

REM 

3530 

REM 

************  NULL  AX 

3570 

REM 

3600 

CALL  AXIS(AX3X,CLR%> 

3610 

IF  13  =  1  THEN  3650 

3620 

13  =  1 

3630 

IT  =  IT  +  1 

3650 

RETURN 

3700 

REM 

3750 

REM 

3800 

REM 

**************  NULL  i 

3850 

REM 

3900 

IF  REG  =  1  THEN  6000 

3905 

IF  11  «  1  THEN  3990 

3910 

IF  X5" =  0  THEN  3920 

39  15 

GOTO  3950 

3920 

11  *  1 

3930 

IT  =  IT  +  1 

3940 

RETURN 

3950 

IF  XI  =  0  THEN  3966 

5960 

GOSUB  4000 

3964 

GOTO  3970 

3966 

GOSUD  4500 

39  70 

11  »  1 

3980 

IT  «  IT  M 

3990 

CALL  AXIS<AX1X,CLRX> 

3991 

RETURN 

3992 

REM 

3994 

REM 

3996 

REM 

****  SPECIAL  ROUTINE 

3998 

REM 

4000 

CALL  AXIS  <  AX2X  > CLR%) 

4002 

CALL  AXIS<AX3X,CLRX> 

.003 

R  =  50 

4004 

FOR  J  =  1  TO  50 

4005 

CALL  AXIS<AX1%» CLRX> 

4020 

CALL  AXIS ( AXIX »  0IR1X ) 

4030 

FOR  K  -  1  TO  R 

4040 

NEXT  K 

4050 

CALL  AXI5(AX1X» CL.R% ) 

4060 

CALL  AXIS  <  AX IX » DIR2X) 

4030 

FOR  K  =  1  TO  R 

4090 

NEXT  K 

4100 

NEXT  J 

\t*  a*  a>  a#  v|/  \i/  ^  a/  a#  a/  vL 

^  ^  ^  ^  ^  ^  ^  ^ 
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4 105 

4110 

4  L  50 

4200  REM 

4 3 0 0  REM 

4350  REM 

4400  REM 

4500 

45.10 

4520 

4530 

4540 

4550 

4560 

4600 

4610 

4620 

4  6  30 

4640 

4650 

5000 

5010 

5020 

5100 

51 10 

5115 

5120 

5800  REM 
5900  REM 
5750  REM 
5960  REM 
6000 
6010 
6020 
6030 
6050 

6100  REM 
6900  REM 
6950  REM 

7000 

7001 

7010  REM 

7020  REM 

’030  REM 

7040 

7045 

7050 

7060 

7 07 0  REM 

’080  REM 
7090  REM 


CALL  AXIS  ( AX  1  %  *  CLR% ) 

ST  =  1 

RETURN 


****  ADDED  ROUTINE  FOR  FULLY  EXTENDED  **## 

IF  X5  =  2  THEN  4600 
CALL  AXIS! AX1Z*CLR%> 

GOSUB  5000 

CALL  AX  I S  ( AX  .1  % » D I R 1  % ) 

GOSUB  5100 

CALL  AX I S ( AX  1 % » CLR% ) 

RETURN 

CALL  AXIS! AX1%»CLR%) 

GOSUB  5000 

CALL  AXIS ( AX1% » DIR2% ) 

GOSUB  5100 

CALL  AX I S ( AX 1 % . CLR% ) 

RETURN 

FOR  J  =  1  TO  240 

NEXT  j 

RETURN 

FOR  J  »  1  TO  79 
NEXT  J 
ST  =  1 
RETURN 


************  NULL  AXIS  ONE  *************** 

CALL  AXIS(AX17.,CLR%) 

IF  II  =  1  THEN  6050 
II  =  1 
IT  =  IT  (■  I 
RETURN 

***********  MOVE  AXIS  FIVE  *************** 

IF  E%( I )  =  2  THEN  7200 
IF  E7.<I>  »  0  THEN  7060 

*****  CLOSE  THE  HAND  ********************* 

CALL  AX.IS<  AX5%f  Cl.R%) 

CALL  AXIS(AX5%»DIR1X) 

GOSUB  8000 
RETURN 

*****  OPEN  THE  HAND  ********************** 


PAGE  3 


APPENDIX  B 


92 


r 


TEACH. BAS 

7200 

CALL  AX 1 3 ( AX5%  > CLR% ) 

7205 

CALL  AXIS <  AX5% , DIR2%  > 

7210 

GOSUB  8000 

7220 

RETURN 

7300  REM 

7410  REM 
7700  REM 

7800  REM  ***********  EXTRA  DELAY  ****************** 

I  7900  REM 

8000  FOR  J  =  1  TO  F% ( I > 

,  3100  NEXT  J 

8200  RETURN 

9000  CALL  AXISC  AX47.,DIRl%) 

9010  RETURN 
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APPENDIX  C 
Bode  Input  Program 
"SQ BODE” 

This  program  was  used  to  generate  a  square  wave 
approximation  of  a  sine-wave  input  to  the  system. 
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10 
20 
30 
4  0 
50 
60 
70 
80 
70 


NUM07.  ■*  0 
NUM1%  "  1 
COLL  PORTS 
PRINT  ‘ENTER 


INPUT 

PRINT 

INPUT 

PRINT 

INPUT 


07. 

“ENTER 

F 

•ENTER 

N 


AXIS  1  TO  5*.  ‘ 

time  delay:’ 
number  of  periods: 


LOO  PRINT 


.10 
.15 
L20 
130 
1  40 
150 
160 
1. 65 
170 
180 
190 
200 
210 
220 
230 
240 
250 

">A  O 


PRINT 

CALL  LLhOLL 
COLL  ENABLE  (NUM1/4) 
FOR  I  =  1  TO  N 
Ii  %  -  1 

COLL  AXIS!  A%fD7.) 
GOSUB  260 
07.  -  0 

CALL  AXISCAXfDX) 

D  7.  =  2 

CALL  AXIS<A7.fD7.)  .. 
GOSUB  260 
CALL  CLRALL 
NEXT  t 

CALL  ENABLE  (NUM07.) 

GOTO  40 

END 

FflR  J  =  1  TO  F 


270  NEXT  -J 
300  RETURN 
310  END 
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UNCLASSIFIED 


F/G  12/1 


MICROCOPY  RESOLUTION  TEST  CHART 

anwiL  »u«e»u  Of  ST»N0»»DS -'»»»-» 
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APPENDIX  D 

Control  Time  Derivation  Program 
"TRIDENT  2" 

Given  the  damping  ratio  and  natural  frequency  as 
user  inputs,  this  program  varied  t^  to  find  t  where  the 
value  of  y(t  )  was  equal  to  the  steady  state  output. 
Equation  4-5  was  used  to  find  t  given  t^,  and  equation 
4-3  was  used  to  find  y(t  )  given  t^  and  tp. 
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A  =  0 
B  =  .1 
C  =  .2 

PRINT  "INPUT  2*ZETA*WN,  WNA2* 

INPUT  D  >  X 
W  =  XA  ♦  5 
Z  =  D/(2*W> 

S  =  Z*W 

Y  -  W#<1-ZA2)A.5 
P  =  3.14159265#  -  ATN ( Y/S) 

E  =  W/Y 

F  a  -Y*COS ( P ) -S*SI N <  P ) +Y#EXP ( S*B ) *COS  <  Y*B+P ) +S*EXP ( 5*B ) #SIN  (  Y*B+F 
G  =  Y*SIN ( P ) -S*COS  <  P ) -Y*EXP  <  S*B ) *SIN  <  Y*B+P ) +S*EXP ( S*B ) *COS ( Y*B+P ) 
T  =  (3.14159265*  -  ATN < ABS < F/G > ) > /Y 

M  a  E*EXP(-S*T>*SIN<Y*T-P>-E*EXP(-S*<T-B>  ) *SIN ( Y* ( T-B > -P > 

IF  ABS(M-l)  <  ,001  GOTO  410 
IF  M  <  1  GOTO  380 
C  =  B 

B  =  A+(B-A)/2 
GOTO  180 
A  =  B 

B  =  HKC-EO/2 
GOTO  130 

PRINT  " YMAG  =  ",M 
PRINT  "WHEN  T 1  =  ",B 
PRINT  "AND  T2  =  ',T 
GOTO  50 
440  END 
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Driver  Routines  for  Hydraulic  Arm 
"AXES" 


This  appendix  contains  the  machine  language  subroutines 
which  were  used  to  drive  the  manipulator. 
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'|^  ^  ^  ^  ^  ^  ^  ^  ^  1^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ty  ^  ^  ^  ^  ^  ^  ^  ^  ‘|^  j|^  ^  ^  ^  «|^  ^  .^»  t|^  .^t  ^  ^  ^  ^  ^  ^  ,^/ 

^  ^  ^  ^  >||  ^  j||  ^  »|^  ^  ^  ^  ^  ^  ^  ^  y|^  ^  ^  ^  \^f  ^  ^  ^  \^  l^t  ^  >|^  ^  «^»  ||^  ^  ^  V^f  y^  ^  ^  ^  yj^  ^  .^>  ^  y^  y^  yj^  yj^  y|^  t|^  *^l  y|^  ^  y^  .|^  y^,  y^  ^  y^ 

DRIVER  ROUTINES  FOR  HYDRAULIC  ARM 


WRITTEN  BY  RICK  BOYER,  8  JUNE  1982 
UP-DATED  16  SEPT.  82  RNB 


ROUTINES  available; 

AXIS  - >  CALL  AXIS(A,B) 

A  -->  AXIS  NUMBER  1  TO  5  (INTEGER) 

B  — >  TO  CLEAR  AXIS  ENTER  =  0 
ENTER  1  OR  2  TO  MOVE  IN 
DIRECTION  REQUIRED.  (INTEGER) 


PORTS  - >  CALL  PORTS 

SETS  UP  THE  8255  PIO  PORTS  FOR 
PROPER  DATA  FLOW  PATHS. 


CLRALL  - >  CALL  CLRALL 

CLEARS  ALL  THE  PORTS  <A,B,C>  TO 
ZERO.  THIS  WILL  ALSO  INITIALIZE 
ALL  THE  TEMP  STORAGE  LOCATIONS. 


ENABLE - >  CALL  ENABLE  <  A ) 

A  — >  1  TURNS  ON  DRIVE  LOGIC  (INTEGER) 
0  TURNS  OFF  DRIVE  LOGIC  (INTEGER) 


*********************************************************** 

*********************************************************** 

CPM  EQU  OOH 
PORTA  SET  OE4H 
PORTB  SET  0E5H 
PORTC  SET  0E6H 
CNTL  SET  0E7H 
PUBLIC  AXIS 
PUBLIC  CLRALL 
PUBLIC  ENABLE 
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public  ports 

TEMP : 

ns 

4 

tempi: 

ns 

4 

TEMP2  J 

ns 

4 

TEMP3J 

ns 

4 

TEMP4  t 
» 

ns 

4 

• 

axis: 

call  errchk 

MOV 

A,M 

sta 

TEMP4 

CPI 

01 

JZ 

AX1 

CPI 

02 

J2  AX2 
CPI  03 
JZ  AX3 
CPI  04 
JZ  AX4 
CPI  05 
JZ  AX5 
LX I  H,MESS2 
MV I  Ei  .LMESS2 
CALL  MSG 
CALL  CLRALL 
CALL  CROUT 
CALL  CPM 

****************** 


AXIJ 

MV I  A  f  01H 
ST  A  TEMP3 
LDA  TEMP 
CPI  00 
JZ  CLR 
CPI  01 
JZ  AX1 A 
MV I  A » 0 1 H 
CALL  SETA 
OUT  PORTA 
RET 

AXIAt  MV I  A»01H 
CALL  SETS 
OUT  PORTB 
RET 

;  *** ***************** 


AX2  J 
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MOI  A r 02H 
STA  TEMP3 
L.DA  TEMP 
CPI  00 
JZ  CLR 
CPI  01H 
JZ  AX2A 
MOI  A,02H 
CALL  SETA 
OUT  PORTA 
RET 

AX2AJ  MO I  A ,02H 
CALL  SETB 
OUT  PORTB 
RET 

» 

t 

f  *  3|t ))[ ))( !jt  ]|C  ]|t  ]|C  1|C  ]|t  * 

* 

AX3  5 

MO I  A  f 04H 
STA  TEMP3 
LB A  TEMP 
CPI  00 
JZ  CLR 
CPI  01H 
JZ  AX3A 
MO I  A,04H 
CALL  SETA 
OUT  PORTA 
RET 

AX3AJ  MO I  A  1 04H 
CALL  SETB 
OUT  PORTB 
RET 

r 

I  lb  Ul  b  b  |b  ^  b  |b  ^  ^  ^  ^  ^  A  ^  ^  ^ 

y  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^ 

♦ 

ax  4: 

MOI  A  1 08H 
STA  TEMP3 
LDA  TEMP 
CPI  00 
JZ  CLR 
CPI  01 H 
JZ  AX4A 
MOI  A 1 08H 
CALL  SETA 
OUT  PORTA 
RET 

AX4AJ  MOI  A  t 08H 
CALL  SETB 
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OUT  PORTS 
RET 


MU I  A  r 10H 
STA  TEMP3 
LDA  TEMP 
CPI  00 
JZ  CLR 
CPI  01H 
JZ  AX5A 
MVI  A f 10H 
CALL  SETA 
OUT  PORTA 
RET 

ax5a:  mvi  a,ioh 

CALL  SETS 
OUT  PORTS 
RET 

* 

* 

•  IjE  3)t  JjC  JflC  J^C  J^C  3^C  3^C  3fC  JjC 

. 

MESS2 J SB  CR,LF,LF, 'ERROR!  !  !  AXIS  #  OUT  OF  RANGE  1  TO  5',CR,LF,LF 

LMESS2  EOU  *-MESS2 

. 

» 

*  iK  5K  3(C  3|C  3|C  3|C  3fC  3fC  JfC  3|C  !|C  )$C  ^  J|(  !fC  3K  )|f  JflC  ^  3|C  <|C  3fC  4 


clr: 

LDA  TEMP3 
MOV  B » A 
LDA  TEMPI 
ANA  B 
JZ  CLRB 
LDA  TEMPI 
XRA  B 
STA  TEMPI 
OUT  PORTA 
RET 

CLRBJ  LDA  TEMP2 
ANA  B 
JZ  CLRC 
LDA  TEMP2 
XRA  B 
STA  TEMP2 
OUT  PORTS 

CLRCJ  RET 
» 

» 

seta: 

MOV  B,A 
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LDA  TEMPI 
ORA  B 
STA  TEMPI 
CALL  CHECK 
LDA  TEMPI 
RET 

♦ 

y 

setb: 

MOV  B t A 
LDA  TEMP2 
ORA  B 
STA  TEMP2 
CALL  CHECK 
LDA  TEMP2 
RET 

♦ 

y 

check: 

LDA  TEMPI 
MOV  B , A 
LDA  TEMP2 
ANA  B 
JNZ  ERROR2 
RET 


ERROR2 J 

LXI  H,MESS4 
MVI  Bf LMESS4 
CALL  MSG 
LDA  TEMP 4 
CALL  NMOUT 
LXI  H.MESS3 
MVI  B,LMESS3 
CALL  MSG 
CALL  CLRALL 
CALL  CROUT 
CALL  CPM 

MESS4JDB  CR,LF,LF, 'ERROR!! !  AXIS  #' 

LMESS4  EQU  *-MESS4 

ME3S3JDB  '  DRIVING  IN  BOTH  DIRECTIONS ', CR , LF ,LF 

LMESS3  EQU  S-MESS3 
♦ 
f 

f  ^  ^  ^  ^  ^  ^  ^  ^  »i|»  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^ 

H  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  * 

♦ 

errchk: 

LDAX  D 
STA  TEMP 
CPI  03H 
JP  ERR1 
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EFiRi:  LX  I  H,MESS1 

MVI  B , LMESS1 
CALL  MSG 
CALL  CLRALL 
CALL  CROUT 
CALL  CPM 

MESSlt  DB  'ERROR!!!  AXIS  DIRECTION  OUT  OF  RANGE ,  ENTER  0  OR  1' 
LMESS1  EQU  $-MESSl 


**********************************  ****** 


CLRALL: 

MVI  A, 00 
OUT  PORTA 
OUT  PORTB 
STA  TEMP 
STA  TEMPI 
STA  TEMP2 
STA  TEMP3 
STA  TEMP4 
RET 

♦ 

f 

;  **************************************** 


ports: 

MVI  Ar88H 
OUT  CNTL 
RET 


;  ####*#*####*##*#######*#*####*##*#***##* 

♦ 

f 

enable: 

MOV  A , M 
CPI  00 
JNZ  ON 
MVI  A, 00 
OUT  PORTC 
RET 

on:  MVI  A»01H 

OUT  PORTC 
RET 


;  ************************************************** 

;  ************************************************** 

♦ 
f 

CR  SET  ODH 
LF  SET  OAH 

♦ 

f 

co: 

PUSH  H 
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PUSH  D 
PUSH  B 
MVI  C»02H 
MOV  E,A 
CALL  OSH 
POP  B 
POP  D 
POP  H 
RET 

♦ 

f 

msg: 

MOV  A » M 
CALL  CO 
INX  H 
OCR  B 
JNZ  MSG 
RET 

♦ 

crout: 

MVI  A,CR 
CALL  CO 
MVI  A,LF 
CALL  CO 
RET 

► 

t 

NMOUT5 

PUSH  H 
PUSH  D 
PUSH  B 
PUSH  PSW 
RRC 
RRC 
RRC 
RRC 

ANI  OFH 
CALL  PRVAL 
CALL  CO 
POP  PSW 
ANI  OFH 
CALL  PRVAL 
CALL  CO 
POP  B 
POP  D 
POP  H 
RET 

♦ 

f 

prval: 

ADI  'O' 

CPI  3AH 
RM 

ADI  7 
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APPENDIX  F 

FORTRAN  User  Subroutine  Library 
"USERLIB" 

This  set  of  FORTRAN  subroutines  was  used  in  "TEACH” 
to  read  the  values  of  the  potentiometers  through  A/D 
converters.  The  Cromemco  8  bit  A/D  converter  was  the  one 
used  in  "TEACH." 
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C******************************************************************** 

C 

c  ***************************************************** 

C  WSSE  FORTRAN  USER  SUBROUTINE  LIBRARY 

C  ***************************************************** 

C 

C 

C  LAST  UPDATED  11/17/81  W.M.L. 

C 

C' ********  Jtc##***##*^#***#***#***#**#####****##*#####****'#*#^#*****^^^* 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c: 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

r: 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


. L*  «!/  >l»  vl/  iL#  ■  L«  «Lj  vi#  iV  U/  U/  U/  Oj  Oj  d«  > L#  Uf  Uf  tl«  ti/  tb  ^  ■! -  •».  .1,  . b 

FORTRAN  MODULES 


CDCCNV  - >  HANDLER  FOR  THE  CAL.  DATA  CORP .  12-BIT  D  TO  A 

BOARD.  THIS  PROGRAM  ALLOWS  THE  USER  TO  ENTER 
THE  VOLTAGE  TO  BE  CONVERTED  AS  A  REAL  NUMBER 
IN  THE  RANGE  -10.00  <  XX. XX  <  10.00.  IT  WILL 
CONVERT  THIS  REAL  NUMBER  TO  A  BINARY 
NUMBER  WHICH  CAN  BE  ACCEPTED  BY  THE  D  TO  A 
CONVERTER. 


CALL  SEQ  CALL  CDCCNV  (CHANNEL, DATA) 

ARGUMENTS  CHANNEL  -  CHANNEL  NUMBER  BETWEEN 

1  AND  4  (LOGICAL) 

DATA  -  DESIRED  OUTPUT  VALUE  (REAL) 

EXTERNALS  DAC12  -  CAL  DATA  DRIVER 

*CROUT,$MSG,*CO  -  TTY  10  ROUTINES 
*AB , *CH , IDA , $L1 , $MA , $ND , $SB , *ST , *T I , *W2 
-  FORM  FORTRAN  LIBRARY 

****** 

TECIN  - >  FOR  THE  TECMAR  12-BIT  A  TO  D  CONVERTER  BOARD. 


THIS  ROUTINE  ALLOWS  THE  USER  CONVERT  ANALOG 
VOLTAGES  RANGING  FROM  -10.00  <  XX. XX  10.00 
VOLTS.  IT  RETURNS  THE  CONVERTED  VOLTAGE  AS 
A  REAL  NUMBER  IN  THE  ABOVE  FORMAT. 

CALL  SEQ  CALL  TECIN  ( CHANNEL , DATA ) 

ARGUMENTS  CHANNEL  -  CHANNEL  NUMBER  BETWEEN 

0  AND  15  (LOGICAL), 

DATA  -  RECEIVED  REAL  VALUE  FROM 
DRIVER. 

EXTERNALS  ADC 12  -  TECMAR  DRIVER 
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C  iCROUT , $MSG , $CQ  -  TTY  10  ROUTINES 

*CA,$DA,*M9,$T1  -  FROM  FORTN.  LIBRARY 

^  ^  ^ 

CROMIN  - >  FOR  THE  CROMEMCO  8-BIT  A  TO  D  BOARD.  THIS 

ROUTINE  ALLOWS  THE  USER  TO  CONVERT  ANALOG 
VOLTAGES  RANGING  FROM  -10.00  <  XX. XX  <  10.00 
VOLTS.  IT  RETURNS  THE  CONVERTED  VOLTAGE  AS 
A  REAL  NUMBER  IN  THE  ABOVE  FORMAT. 

CALL  SEQ  CALL  CROMIN  (CHANNEL, DATA) 

ARGUMENTS  CHANNEL  -  CHANNEL  NUMBER  BETWEEN 

1  AND  7  (LOGICAL). 

DATA  -  RECEIVED  REAL  VALUE  FROM 
DRIVER. 

EXTERNALS  ADC08  -  CROMEMCO  A/D  DRIVER 

SCROUT, *MSG,*CO  -  TTY  10  ROUTINES 
*CA,*DA,*M9,*T1  -  FROM  FORTN.  LIBRARY 

****** 

CROMCO  - >  HANDLER  FOR  THE  CROMEMCO  EIGHT  BIT  D  TO  A 

BOARD. VOLT AGE  TO  BE  CONVERTED  IS  ENTERED 
AS  A  REAL  NUMBER  IN  THE  RANGE  -10.00  < 

XX. XX  <  10.00.  THIS  WILL  BE  CONVERTED  TO 
AN  EIGHT  BIT  BINARY  NUMBER  AND  PASSED  TO 
THE  CROMEMCO  DRIVER. 

CALL  SEQ  CALL  CROMCO  (CHANNEL,  DATA) 

ARGUMENTS  CHANNEL  -  CHANNEL  NUMBER  BETWEEN 

1  AND  7  (LOGICAL) 

DATA  -  DESIRED  OUTPUT  VALUE  (REAL) 

EXTERNALS  DAC08  -  CROMEMCO  7DAI0  D/A  DRIVER 

tCROUT , $MSG,$CO  -  TTY  10  ROUTINES 
$AB , *C J , *DB , *LI , $MA , $ND , $SD , mST , *T I , *W2 
-  FROM  FORTRAN  LIBRARY 

PROGRAMMING  NOTE  -  THIS  DEVICE  USES  SAMPLE  AND 

HOLD  CIRCUITRY  TO  STORE  OUTPUT 
VOLTAGE.  IT  MUST  BE  REFRESHED 
OFTEN  TO  CORRECT  DRIFT. 

****** 

C************ ****************************************** ************** 
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i)v  ill  U#  U/  Ul  vli  Uf  U/  U/  \i/  ■  t*  iij  U/  dj  iu  it/  ti/  tl/  c|#  «V  ib  ■  *  *  ■  l»  lb  *  lb  lb  lb 

MACRO  SUBROUTINES 
******************************* 

FRNTHX  - >  PRINTS  THE  HEX  EQUIV.  OF  THE  INTEGER  INPUT 

CALL  SEQ  CALL  PRNTHX  (IDATA) 

ARGUMENTS  IDATA  -INTEGER  TO  BE  DUMPED 

EXTERNALS  UCROUT , 4NM0UT , $PRVAL , *CO  -  TTY  l  CONVERSION  SUBS 

****** 

FNMOUT  - >  PRINTS  HEX  EQUIV.  OF  BYTE  WIDE  NUMBER 

CALL  SEQ  CALL  FNMOUT  <  LDATA) 

ARGUMENTS  LDATA  -  BYTE  WIDE  DATA  TO  BE  DUMPED 

EXTERNALS  $NMOUT , *PRVAL , $CO  -  TTY  10  ROUTINES 

****** 

FCO  - >  PRINTS  BYTE  WIDE  DATA  IN  ASCII 

CALL  SEQ  CALL  FCO  (LDATA) 

ARGUMENTS  LDATA  -  BYTE  TO  BE  TYPED  (LOGICAL) 

EXTERNALS  *C0  -  TTY  CHARACTER  OUT 

****** 

FCI  - >  READS  BYTE  OF  DATA  FROM  TERMINAL  IN  ASCII 

CALL  SEQ  CALL  FCI  (LDATA) 

ARGUMENTS  LDATA  -  ASCII  BYTE  READ  FROM  TERMINAL 

EXTERNALS  tCI  -  TTY  CHARACTER  IN 

****** 

MULOUT  - >  DRIVER  FOR  MULLEN  CONTROL  BOARD  OUTPUT 

CALL  SEQ  CALL  MULOUT  (LDATA) 

ARGUMENTS  LDATA  -  BYTE  WIDE  DATA  TO  RELAYS 

(LOGICAL) 
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EXTERNALS 

* 

MULLIN  - 

CALL  SEG 
ARGUMENTS 

EXTERNALS 

* 

ADC 12  - 

CALL  SEQ 
ARGUMENTS 

EXTERNALS 

* 

DAC12  - 

CALL  SEG 
ARGUMENTS 

EXTERNALS 

* 

ADC08  - 

CALL  SEG 
ARGUMENTS 

EXTERNALS 


USERLIB.DOC  5-2-83 

NONE 

*  *  *  *  * 

>  DRIVER  FOR  MULLEN  BOARD  INPUT 

CALL  MULLIN  (LDATA) 

LDATA  -  BYTE  WIDE  DATA  FROM  OPTO- 
COUPLERS  (LOGICAL) 

NONE 

%  %  %  %  % 

>  DRIVER  FOR  TECMAR  12BIT  A/D 

CALL  ADC 12  ( LCHAN , I DAT  A ) 

LCHAN  -  CHANNEL  NUMBER  BETWEEN  0  AND 
15  (LOGICAL). 

••  IDATA  -  SIGNED  INTEGER  REPRESENTING  THE 
CONVERTED  VALUE. 

$CROUT . $MSG , *CO  -  TTY  ROUTINES 

*  *  *  *  * 

>  DRIVER  FOR  CAL,  DATA  12  BIT  D/A 

CALL  DAC12  (LCHAN, IDATA ) 

LCHAN  -  CHANNEL  NUMBER  BETWEEN  1  AND 
4  (LOGICAL)? 

IDATA  -  SIGNED  INTEGER  VALUE 

$CROUT,*MSG,*CO  -  TTY  10  ROUTINES 

***** 

■>  DRIVER  FOR  CROMEMCO  8  BIT  A/D 

CALL  ADC08  (LCHAN, LDATA) 

LCHAN  -  CHANNEL  NUMBER  BETWEEN  1 
AND  7  (LOGICAL) 

LDATA  -  BYTE  WIDE  DATA  TO  BE  CONVERTED 
(LOGICAL) 

♦CROUT, ,*MSD,*CD  -  TTY  ROUTINES 
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****** 

DAC08  - >  DRIVER  FOR  CRQMEMCO  D/A  CONVERTER 

CALL  SEQ  CALL  DAC08  (LCHAN, LDATA) 

ARGUMENTS  LCHAN  -  CHANNEL  NUMBER  BETWEEN  1 

AND  7  (LOGICAL). 

LDATA  -  BYTE  WIDE  DATA  TO  BE  CONVERTED 
(LOGICAL) . 

EXTERNALS  *CROUT , $MSG , *CO  -  TTY  10  ROUTINES 

****** 

DDCOUT  - >  DRIVER  FOR  CROMEMCO  DIGITAL  10  OUTPUT 

CALL  SEQ  CALL  DDCOUT  (LDATA) 

ARGUMENTS  .  LDATA  -  BYTE  DATA  TO  INPUT  (LOGICAL) 

EXTERNALS  NONE 

****** 

DDCIN  - >  DRIVER  FOR  CROMEMCO  PIO  INPUT 

CALL  SEQ  CALL  DDCIN  (LDATA) 

ARGUMENTS  LDATA  -  BYTE  WIDE  DATA  TO  XMIT  (LOGICAL) 

EXTERNALS  NONE 

****** 
rf,  He  *  *  ij(  He  *  He  *  He  He  *  *  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He  He 

IJSERLIB  INTERNAL  ROUTINES 

note:  these  routines  are  not  callable  from  fortran. 


*CRLF  OR  *CROUT  ->  GENERATES  A  CARRIAGE  RETURN  -  LINE  FEED 

SEQUENCE  TO  THE  TERMINAL. 

CALLS  *C0  -  TTY  CHARACTER  OUT 

$NMOUT  - >  PCONVERTS  AN  8  BIT  BINARY  NUMBER 

TO  ASCII  HEX  AND  PRINTS  IT  ON  THE 
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TERMINAL. 

CALLS  $PRVAL,*CO  -  CONVERSION  %  TTY  OUT 

$PRVAL - >  CONVERTS  HEX  DIGET  TO  ASCII. 

*CNVBN  - >  CONVERTS  ASCII  DIGET  TO  HEX. 

*MESS  OR  *MSG  - >  PRINTS  ASCII  MESSAGE  TO  THE  TERMINAL. 

CALLS  tCO  -  TTY  CHARACTER  OUT 

*CO  - >  PRINTS  ASCII  CHARACTER  TO  THE  TERMINAL. 

$CI  - >  READS  ASCII  CHARACTER  FROM  THE  TERMINAL. 


^  ^  ^  ^  ^  Ui  d<  ^  Up  Up  Up  ^  tfa  Up  ^p'  ^  ^  ^  ^  ^  Ui  ^  ^  ^  A  ^  Up  UU  Up  ^  Up  ^  Up  ^  ^  Up  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  Up  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  a.  ^  ^  ^ 

*  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^  ^ 

TO  BUILD  USERLIB.REL  ,  USE  THE  MICROSOFT  LIBRARIAN 
AS  FOLLOWS  TO  LINK  THE  *  .REL*  MODULES*. 

>A  LIB 

*USERLIB=TECIN,CDCCNV,CR0MIN,CR0MC0,ADC08,DAC08 
*USERL  I  B= ADC  1 S’,  D  AC  1 2 ,  DDC I N ,  DDCOUT , MULL I N , MULOU  T 
*USERLIB=PRNTHX , FNMOUT ,  FC I , FCO , NMOUT , MSG , CROUT 
*USERLIB=CNVBN , PRVAL , Cl , CO 
*/E 

NOTE:  MODULES  MUST  BE  IN  ABOVE  ORDER  SO  THAT  THEY 
WILL  BE  FOWARD  REFERENCED. 

TO  LINK  WITH  L80-  CMNDFILE=QBJFILE f USERLIB/S 

30C  #  )jt  )jC  30C  !jt  )|(  3((  ^  30C  %  *  30C  ♦  %  )|C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  30C  3|C  30.  30C  30C  30C  30C  30C  30C  Jj(  30C 
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